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(57) ABSTRACT 

A system for and method of determining an input command 
profile for substantially any dynamic system that can be 
modeled as a linear system, the input command profile for 
transitioning an output of the dynamic system from one state 
to another state. The present invention involves identifying 
characteristics of the dynamic system, selecting a command 
profile which defines an input to the dynamic system based 
on the identified characteristics, wherein the command pro- 
file comprises one or more pulses which rise and fall at 
switch times, imposing a plurality of constraints on the 
dynamic system, at least one of the constraints being defined 
in terms of the switch times, and determining the switch 
times for the input to the dynamic system based on the 
command profile and the plurality of constraints. The char- 
acteristics may be related to poles and zeros of the dynamic 
system, and the plurality of constraints may include a 
dynamics cancellation constraint which specifies that the 
input moves the dynamic system from a first state to a 
second state such that the dynamic system remains substan- 
tially at the second state. 

28 Claims, 33 Drawing Sheets 
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METHOD AND APPARATUS FOR CREATING 
TIME-OPTIMAL COMMANDS FOR LINEAR 
SYSTEMS 

This application is a continuation of and claims priority 
to U.S. application Ser. No. 09/261,987 filed Mar. 4, 1999, 
which claims priority to U.S. Provisional Application No. 
60/076,951 filed Mar. 5, 1998. Both of these references are 
hereby incorporated by reference in their entirety. 

GOVERNMENT SUPPORT 

This invention was made with government support under 
Contract Number NAGW-1335, awarded by NASA. The 
United States government has certain rights in the invention. 

BACKGROUND OF THE INVENTION 

1. Field of the Invention 

The present invention is directed to a system for creating 
commands that increase the speed of system response. The 
invention can be applied to virtually any type of machine, 
process, or entity that can be modeled linearly. In particular, 
the invention deals with the creation of command profiles 
that are time-optimal, meaning commands that will move a 
system from one rest state to another rest state in the shortest 
amount of time. To this end, the invention provides a 
three-step procedure for generating time-optimal command 
profiles for all types of linear single-input, single-output 
systems. Constraint equations that result from this approach 
are both notationally and computationally simple. 
Consequently, the invention delivers results for complex 
systems faster and more reliably than traditional approaches. 
The invention furthermore incorporates additional practical 
constraints into its solution framework, thereby producing 
different types of time -efficient commands which satisfy a 
range of system performance requirements. 

2. Description of the Related Art 

With every passing year, the modern world demands that 
things change faster than they did before. In machines, 
processes, and attitudes, success is often defined by the 
speed with which these transitions can be made. In the 
information storage industry, for example, the speed of 
change is the primary performance metric than can make or 
break a product. In every computer disk drive or compact 
disk player, data storage and retrieval is performed by a 
read-write head that must scan rapidly from one disk track 
to another. The speed at which this read-write head can 
reposition itself between tracks is directly related to the 
speed of information access and the overall performance of 
the product. As another example of the importance of rapid 
change, the modern manufacturing environment contains 
many types of automated machines that are used for preci- 
sion positioning, assembly, and inspection operations. The 
performance of these machines is measured largely by their 
ability to produce rapid and precise motions. Companies 
typically focus considerable attention toward improving the 
speed of these machines in order to maximize the throughput 
of the entire plant. 

As with disk drives and manufacturing systems, it is not 
difficult to think of examples of automated machines that 
could benefit by an enhanced speed of operation. 
Furthermore, this rationale can be extended beyond 
mechanical hardware to many other kinds of systems. The 
pilot of a fighter jet, for example, would probably be very 
interested in the fastest way to change altitude if trying to 
avoid an oncoming missile. One could also imagine a stock 
broker working with a complicated financial model won- 
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dering how to quickly maximize profits by varying his 
investment portfolio. Alternately, the operators of a hydro- 
electric power plant might wish to increase the plant’s power 
output as fast as possible to meet a sudden increase in 
5 demand. In all of these cases, as well as countless others, a 
knowledge of how to change things quickly would prove 
highly valuable. 

Understanding how to move things faster can go a long 
way toward enhancing the performance of many systems. In 
10 some situations, however, this is not enough. Imagine a 
manufacturing robot moving so quickly that it tears itself 
from the factory floor. Or, how about a weather satellite that 
can scan the atmosphere with blazing speed but, in the 
process, exhausts its supply of fuel. One can imagine that the 
!5 chairman of the Federal Reserve has more on his mind when 
adjusting interest rates than reducing inflation as rapidly as 
possible. Since he knows that his economic models are not 
perfect, he opts for a prudent schedule of interest rate 
adjustment in order to reliably and gradually improve eco- 
20 nomic indicators. In most applications, resting alongside the 
need for speed is such a set of practical issues that must also 
be addressed. 

The modern world demands indeed that many systems 
change in a rapid and desirable manner. The question that 
25 still remains, however, is how to effect this change. As 
varied as the performance demands from system to system, 
so are the strategies for meeting these demands. A disk drive 
designer, for example, might choose to use a lighter material 
or a different type of actuator to reduce the access time of his 
30 drive. As an alternate approach, he might also decide to 
outfit his machine with sensors and develop a high- 
performance control system to meet more stringent perfor- 
mance specifications. These two strategies, hardware rede- 
sign and enhanced feedback control, are both viable 
35 methods for improving system performance. Many systems, 
however, do not tolerate these types of changes. An engineer 
at a hydroelectric plant, for example, would be foolhardy to 
consider building a new dam to better control the power 
output. Similarly, commissioning the Space Shuttle to install 
40 new sensors on an operating weather satellite might also 
prove equally absurd. In situations like these, engineers must 
focus their effort on improving performance by working 
with the system at hand. Even for systems that can be 
improved through hardware redesign and feedback control, 
45 the designer must then work with the improved system to 
further maximize performance. 

The question, then, that remains is how to control the 
inputs to a given system to achieve a desired behavior at the 
system’s output. For example, how can a crane operator best 
50 position a joystick to maneuver a cargo crate from a trans- 
port ship to a train platform as quickly as possible? What 
kind of torque profile should a designer specify in a disk 
drive actuator to most efficiently move the read-write head 
of the drive from track to track? How should the Fed vary 
55 the interest rate to quickly and reliably control inflation? The 
answer to each of these questions depends on many different 
factors. Understanding these factors and how they influence 
performance is the key to understanding how to answer 
these questions. 

60 1 The Feedforward Control Problem 

The problem facing designers who wish to improve the 
performance of their systems, which can be called “the 
feedforward control problem”, addresses the question of 
how to select the input command for a given system that 
65 produces the most desirable output response. As illustrated 
in FIG. 1, the feedforward control problem can be stated as 
follows: 
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Given a known system, what is the input command that 
will move the output of the system from one state to 
another in the most desirable manner? 

When stated in this form, it can be reasoned that the answer 
to this question will depend on four different factors. These 
four factors are as follows. 

1. The first factor which influences the profile of the input 
is the nature of the change in the system output. For 
example, the actuator command that will best move a 
scanning sensor on a weather satellite over a ninety 
degree slew will probably have little resemblance to the 
command required to complete a three degree slew. 

2. The second factor which influences the system response 
to an input command is the dynamic behavior of the 
system. In manufacturing systems, for example, this 
becomes apparent as machines are designed to be 
lighter and faster. As an unfortunate side-effect of these 
performance enhancements, undesirable machine 
dynamics often become the primary barrier to further 
performance improvements. For example, in many 
high-performance assembly systems, the speed with 
which a machine can operate is dictated not by the time 
required to execute positioning maneuvers, but rather 
by the time required for unwanted vibrations to settle. 
Consequently, the best input command profile for a 
given high-performance system should not ignore the 
dynamics of the system. 

3. The third factor that should be considered when 
answering the foregoing question is the allowable level 
of the system inputs. One straightforward way to 
improve the speed of response in a manufacturing 
robot, for example, is to employ powerful actuators. 
However, due to design limitations, actuator capacity 
must often be restricted. As a result, motion commands 
used for these systems should be designed to remain 
within the actuator capability. Given this constraint, it 
can be reasoned that the command profiles that deliver 
the best system performance should account for the 
limitations of the system inputs. 

4. The fourth factor that should be considered is system 
performance variables. In this regard, in addition to 
accounting for desired output behavior, system 
dynamics, and input limitations, many systems may be 
sensitive to other performance variables. For example, 
for systems that have shifting or uncertain dynamics, 
the performance delivered by input commands must 
remain robust to these changes. Other systems may 
have additional requirements such as limitations on 
internal loading or energy efficiency. Any useful strat- 
egy for creating command profiles should effectively 
address these practical concerns. 

Although the feedforward control problem, as posed 
above, is still fairly broad, it has helped to identify four 
issues that influence its solution. Any strategy designed to 
address the stated problem should address these four issues. 
As one way of looking at the task at hand, FIG. 2 illustrates 
that the problem is to determine a strategy for using infor- 
mation about (1) the desired system output response, (2) the 
system dynamics, (3) the limitations on the system inputs, 
and (4) any additional constraints in order to derive the best 
input command for a given system. Before this strategy can 
be formulated, however, the problem statement must be 
further clarified in order to define system behavior and 
performance in more concrete terms. 

The feedforward control problem, as noted above, is a 
general statement that outlines the basic issues associated 
with selecting an input command profile for a given system. 
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This problem statement, however, is far too general to lend 
insight into a solution approach. To further clarify the 
problem, the following assumptions will be made to limit the 
scope of the solution approach to more manageable levels. 
5 First, it will be assumed that the system under consider- 
ation can be modeled linearly. Although ignoring a certain 
class of systems that cannot be described by linear 
representations, this assumption allows all the tools of linear 
system theory to be enlisted to help solve this problem. Note 
10 that, as long as the input-output behavior of a given system 
can be modeled linearly, solutions can be applied to both 
open-loop and closed-loop systems. Second, it will be 
assumed that all systems under consideration are single- 
input, single-output (SISO). However, it is noted that the 
!5 invention described herein can also be used with multiple- 
input, multiple-output (MIMO) systems. Third, it will be 
assumed that the goal of the problem is to transition the 
system output rapidly from one rest state to another rest 
state. With these three basic assumptions, the feedforward 
20 control problem has been reduced to one of more manage- 
able complexity. Labeled “the time-efficient control 
problem,” this reduced problem is illustrated in FIG. 3 and 
can be stated as follows. 

For a given SISO linear system, G(s), find the input 
25 command, u(t), that will move the system output, y(t), 
from one rest state to another in the shortest possible 
time subject to constraints such as: (1) actuator limits, 
(2) robustness to system uncertainty, (3) fuel usage 
requirements, etc. 

30 As will be discussed later herein, this time-efficient problem 
formulation lends itself to a particular class of command 
solutions. These types of solutions can all produce a rapid 
state change at the system output while satisfying a variety 
of additional constraints. If time is the only performance 
35 variable of interest in a system, this problem can be reduced 
even further by eliminating all unnecessary constraints. 
Known widely as “the time-optimal control problem,” this 
most fundamental form of the feedforward control problem 
is illustrated in FIG. 4 and can be stated as follows: 

40 For a given SISO linear system, G(s), find the input 
command, u(t), that will move the system output, y(t), 
from one rest state to another in the shortest possible 
time subject to the actuator constraints: u mi -„<u(t)<u max . 

Unlike the time -efficient control problem statement, the 
45 time-optimal control problem requires that only two condi- 
tions be met: (1) that the system output transition by an 
amount dy, and (2) that the input command remain within 
the actuator limits. These two problem specifications repre- 
sent the minimum set of constraints required to ensure a 
50 nontrivial solution to this problem. Furthermore, any com- 
mand that satisfies this problem defines the performance 
baseline for how fast a linear system can be moved from one 
state to another. Because of the fundamental importance of 
this problem statement, the time-optimal control problem 
55 has been the subject of investigation for over forty years. 

2 The Time -Optimal Control Problem 

With this long history of research, it is difficult to know 
where to begin to describe the state of the art. Accordingly, 
the discussion herein will move from the general to the 
60 specific. To this end, the discussion will begin with an 
overview of work in the design and control of flexible 
systems. A large area of research in itself, many of the recent 
advances in time-optimal and time-efficient control were 
spawned from investigations in new techniques for control- 
65 ling flexible machines. From this point, the discussion will 
turn from feedback to feedforward control. Since this docu- 
ment is concerned primarily with generating input command 
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profiles, section 2.2 surveys various techniques for deriving 
motion command profiles for different types of systems. 
Two specific command generation techniques, time -optimal 
control and input shaping, have relevance to the work in this 
document. Consequently sections 2.3 and 2.4 are devoted to 
outlining the basic theories and the state of the art for each 
of these techniques. From this background on input shaping 
and time-optimal control, section 2.5 focuses on identifying 
the strengths and similarities of these two approaches. 
Building on this comparison, the need for a general approach 
for deriving time -efficient and time-optimal commands 
becomes clear. 

2.1 Design and Control of Flexible Systems 

The first step in creating a high-performance machine or 
system is to design and construct the hardware. In approach- 
ing this task, design engineers typically face a variety of 
design tradeoffs that influence the construction of the hard- 
ware and the performance of the machine. For machines that 
operate in speed-critical environments, designers often try to 
maximize the speed of system response by making machine 
components powerful and lightweight. At the same time, in 
order to minimize problematic vibrations, designers must 
also look to make structural components rigid. Primarily due 
to space, weight, and power constraints, this is not always 
possible. One strategy for overcoming this design obstacle is 
to modify the mechanical structure by adding damping. With 
increased structural damping, vibrations settle quicker and 
are less likely to degrade machine performance. One of the 
simplest and oldest techniques for adding structural damping 
is to use a tuned vibration absorber [1]. Although this is an 
old idea, the technique has evolved into a sophisticated tool 
and many promising modifications to the method are con- 
tinually being developed [2]. When design considerations do 
not allow for this kind of hardware augmentation, the design 
engineer must turn to feedback approaches to eliminate 
undesirable system dynamic behavior. 

In the past fifteen years, research in the area of control of 
flexible systems has been abundant. Targeted primarily 
toward boosting the performance of flexible satellites and 
robots, this research has explored a wide spectrum of 
feedback control concepts. In his 1996 survey paper, [6], 
Wayne Book presents an overview of some of the work in 
this field. Junkins and Kim also provide a thorough treat- 
ment of this subject in their recently published textbook [4]. 
Although providing a detailed account of the work in this 
field is beyond the scope of this patent, some effective 
strategies for controlling flexible systems can be found in 
[5-12]. In all of these works, and in many others, closed- 
loop control strategies have been demonstrated to work 
effectively at preserving system performance in the face of 
unwanted vibration. From this result, it can be argued that a 
good control system is an essential component of a high- 
performance machine. However, in some systems, such as 
ones where sensor feedback is unavailable, high- 
performance control is not an option. In these cases, the 
designer must turn to feedforward methods for meeting 
performance requirements. Additionally, even in systems 
that employ effective controllers, feedforward techniques 
can commonly be used to gain an extra measure of perfor- 
mance. 

2.2 Survey of Feedforward Control Methods 

As Wayne Book notes in [3], “our best hope to expand the 
envelope of feasible performance is a confluence of open- 
and closed-loop controls, design innovations, material 
improvements and sensor and actuator developments/’ As 
discussed herein above, researchers have taken this message 
to heart and work has been prolific in both the areas of 
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hardware innovation and closed-loop control. What should 
not be overlooked, however, is the critical importance of 
open-loop, or feedforward control, techniques for enhancing 
machine performance. While closed-loop control techniques 
5 are used for minimizing error in the face of disturbances, 
they cannot always be optimized for the task at hand. In a 
factory robot, for example, the same pick-and-place task 
might be performed thousands of times every day. The 
feedback controller used by this robot, instead of being 
10 finely tuned to effectively accomplish the specific pick-and- 
place task, must likely be designed to meet such perfor- 
mance specifications as good stability robustness and dis- 
turbance rejection. In situations like these, the onus falls on 
a feedforward controller to specify the best command that 
15 will move the robot most effectively. From this rationale, the 
importance of an effective feedforward controller, working 
independently of or alongside a feedback controller, is clear. 
This section is devoted to presenting an overview of some of 
the research that has been performed in the area of feedfor- 
20 ward control. Much of this research can be divided into four 
categories: (1) trajectory tracking, (2) command formulation 
using analytic functions, (3) optimal control command 
formulation, and (4) time-optimal and time -efficient com- 
mand generation. The first three of these categories are 
25 concerned with deriving command profiles for applications 
that are not necessarily time-critical. The last category 
presents feedforward approaches catered to systems that 
need rapid response. In this realm of time-efficient 
approaches, two specific bodies of work, time-optimal con- 
30 trol and input shaping, will be addressed in detail in later 
sections. 

2.2.1 Deriving Commands for Trajectory Tracking 

In automated equipment such as milling machines and 
pen plotters, the speed of the system response is secondary 
35 to path -following accuracy. For situations like these, feed- 
forward control methods are targeted at generating motion 
paths that minimize machine tracking error. Perhaps the 
most common approach for achieving these performance 
specifications is to use inverse dynamics. Inverse dynamics 
40 refers to a technique for filtering input commands by the 
inverse of the system model so that the system output tracks 
a desired trajectory despite system flexibility. Recent 
research in this area has led to new approaches for achieving 
precise tracking in mechanical systems. Tomizuka [13, 14], 
45 for example, proposed a technique for generating causal 
command inputs to allow a system to follow a specified path. 
In this technique, guidelines were presented for dealing with 
uncancellable zeros in the system model without causing 
phase distortion in the shaped command. Tung [15] 
50 extended this theory by proposing a technique for improving 
accuracy by penalizing model error more heavily for lower 
frequencies. Asada [16, 17] successfully applied inverse 
dynamics to a flexible multiple-link robot and proposed an 
efficient computational scheme to generate the shaped tra- 
55 jectories. By using an inverse dynamics approach to con- 
struct shaped commands from a sum of sinusoids, Tu [18] 
also demonstrated that flexible systems could benefit from 
inverse dynamics feedforward control. Additional tech- 
niques for using feedforward control to enhance trajectory 
60 tracking performance can be found in [19-22]. 

2.2.2 Command Formulation Using Analytic Functions 
Another approach for generating commands for systems 

is by using analytic functions with known frequency- and 
time-domain characteristics to construct commands with 
65 desirable properties. These techniques are often used, for 
example, to generate fixed-time -length commands with 
reduced energy at the problematic system modes. Some of 
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the researchers in this area include Aspinwall [23], who 
proposed a technique for minimizing residual vibration in 
flexible systems by generating shaped commands using 
Fourier series. Wiederrich [23-26] used finite trigonometric 
series to generate high-speed cam profiles to avoid exciting 
machine vibration. Similarly, Swigert [27] outlined a 
method for minimizing modal vibration in a flexible satellite 
using shaped torque commands constructed from a finite 
trigonometric series. Adopting a similar shaped-function 
synthesis approach, Meckl [28-31] combined ramped- 
sinusoid functions to minimize residual vibration from 
point-to-point motion in flexible systems. Some additional 
techniques for constructing functions to yield desirable 
motion profiles can be found in [32-34]. 

2.2.3 Optimal Control Command Formulation 

Building on the concepts and tools developed for optimal 
feedback control, several techniques have been presented for 
applying optimal control approaches to the generation of 
input commands. Classifying this field of research as opti- 
mal control command formulation, these approaches typi- 
cally employ optimal control theory to generate shaped 
commands that minimize a specific cost index such as 
command energy or residual vibration. Perhaps the first 
application of optimal control to generate feedforward com- 
mands for flexible systems was proposed by Farrenkopf 
[35]. In his work, an analytic solution was derived for the 
input command that minimized structural excitation and 
residual vibration in an undamped second-order system. 
Turner [36, 37], using a numerical optimal-control solution 
technique, derived shaped commands that minimized a 
weighted sum of state deviation and control effort in 
undamped, nonlinear, multiple-mode systems. These shaped 
commands were constrained to produce system response 
with zero residual vibration. In later work, Eisler [38] used 
a similar numerical optimization approach to find the 
minimum-time motion of a two-link robot with actuator 
limits subject to constraints on the tracking error and 
residual vibration of the robot. Parker [39] applied a 
dynamic programming and parameter optimization 
approach to derive commands for point-to-point motion in 
cranes. In other work, Bhat [40-46] used a Linear Quadratic 
Regulator approach to derive a closed-form solution for the 
minimum energy point-to-point command for a flexible 
system. Last, relying on a full non-linear model, Meckl [47] 
proposed a numerical optimization technique for generating 
minimum-energy commands to effect point-to-point motion 
in flexible, nonlinear systems. 

2.2.4 Creating Time-Optimal and Time-Efficient Commands 

For automated systems that require rapid motion, feed- 
forward commands should be designed to maximize the 
speed of response. Numerous methods have been proposed 
by designers to create these time-optimal and time-efficient 
commands. Two, in particular, are of interest: time-optimal 
control and input shaping. Time-optimal control refers to the 
field of research dedicated to finding the input command that 
will move a system as fast as possible from one point to 
another. Much research has been performed in this area in 
the past forty-five years, and the following section will 
attempt to present an overview of some of this work. The 
second area of research to be discussed in detail, input 
shaping, is a field based on a strategy for deriving time- 
efficient discontinuous command profiles that suppress 
residual vibration and are robust to system uncertainties. 
Much attention has been focused on this subject in the past 
ten years, and section 2.4 will give a detailed account of this 
research effort. 

In addition to time-optimal control and input shaping, 
many other techniques exist for creating time-efficient com- 
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mands. For example, some researchers [48-50] have set 
conventional digital filtering techniques to the task of com- 
mand profile design. Work in this area has revealed that 
these filtering approaches can be effective for deriving 
5 relatively fast commands that avoid exciting unwanted sys- 
tem vibration. By constructing command profiles from a 
series of correctly timed pulses, other researchers [51-55] 
have illustrated that rapid motion can be produced in some 
flexible systems without residual vibration. These tech- 
10 niques and others have successfully demonstrated that many 
approaches can be adopted for creating time-efficient com- 
mands for flexible systems. The following two sections 
focus on two particular techniques that have demonstrated 
widespread use and acceptance: the first, time-optimal 
15 control, stands alone for its power and generality, and the 
second, input shaping, gains distinction for its simplicity and 
practicality. 

2.3 Time- Optimal Control 

The time-optimal control problem, as stated above, is 
20 concerned with finding the fastest possible ways to move 
systems from one state to another. Much of the research in 
this field can be divided into two schools. The first school, 
comprised of work performed primarily in the 1950’s and 
1960’s, was concerned with developing the underlying 
25 mathematical theory for time-optimal control. Due in part to 
the complexity of these initial approaches and since energy - 
based control methods promised greener pastures, work in 
this area was largely abandoned. More recently, perhaps in 
the past fifteen years, a new school of work has formed. This 
30 new approach to time-optimal control has been driven by 
expanding research efforts in the control of flexible struc- 
tures as well as new computer capabilities. The result of this 
new school of work has been the development of new 
techniques for solving for time-optimal command profiles 
35 for a small class of flexible systems. This section proposes 
to present an overview of the state of the art in time-optimal 
control and will address both underlying principles as well 
as recent advancements in this field. This discussion will 
begin by describing the origins of time-optimal control as 
40 found in Pontryagin’s Maximum Principle and the Bang — 
Bang Principle. Approaches for applying these theories to 
nonlinear systems will then be addressed followed by an 
overview of recent work in deriving time-optimal com- 
mands for linear systems. 

45 2.3.1 Pontryagin’s Minimum Principle and the Bang — Bang 
Principle 

For over forty years, researchers have been investigating 
strategies for finding time-optimal commands. Much of this 
research has resulted from Pontryagin’s original formulation 
50 and investigation of the time-optimal control problem [56]. 
In this original work, Pontryagin outlines a set of necessary 
conditions that the time-optimal control for a system must 
satisfy. Specifically, these conditions require that the time- 
optimal control which transitions a system from a fixed 
55 initial state to a desired final state must necessarily satisfy 
the following conditions: (1) it must satisfy the system state 
and costate equations, (2) it must remain within the given 
actuator limits and minimize the Hamiltonian, and (3) it 
must result in a Hamiltonian value of zero over the time- 
60 length of the command. The mathematical details of this 
principle are avoided here but outlined below in section 
6.2.1 of this document. Also, a comprehensive treatment of 
this principle, including a detailed derivation, can be found 
in [57]. A less detailed overview of the fundamentals of the 
65 principle can be found in [58]. Due to its generality, Pontrya- 
gin’s Minimum Principle proved to be a theory of far- 
reaching impact. Not only did it allow researchers to make 
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strong claims about the nature of time-optimal commands 
for linear and nonlinear systems, but its result can be applied 
with equal efficacy to SISO and MIMO systems alike. 

Stemming from the powerful insights of the Minimum 
Principle, the Bang — Bang Principle further postulates 
about the nature of the shape of time-optimal commands. 
Phrased by Hermes [59] as follows, the Bang — Bang Prin- 
ciple states that “ ... if it is desired to have the system 
change from one state to another in minimum time, then it 
is necessary at all times to utilize the power available; that 
is, to use bang — bang control.” With this assertion, the 
time-optimal command for a given system, must have a 
value that always maximizes, in a positive or negative sense, 
at least one of the system actuators. For a system with a 
single input, the time-optimal command, such as the one 
shown in FIG. 5, must always saturate the system actuator. 
The resulting command profile for such a system will 
consist, therefore, of a series of positive and negative pulses 
with a finite number of times where the command value 
switches between the positive and negative limit. This 
observation greatly simplifies the time-optimal control prob- 
lem by reducing the solution space of possible command 
profiles to simply the set of possible switch times. 

2.3.2 Time-Optimal Control of Nonlinear Systems 

Pontryagin’s Minimum Principle provides powerful tools 

for assessing the time-optimality of system commands. 
Unfortunately, applying these tools to the task of deriving 
commands for a given system is not immediately straight- 
forward. For very simple systems, some analytic solutions 
for time-optimal commands exist [57], but in general, com- 
mands must be derived numerically. A number of techniques 
have been proposed for doing this, but all are numerically 
intensive and largely too unreliable to be applied to a wide 
class of systems. The general approach for deriving time- 
optimal commands typically relies on solving a two -point, 
boundary-value problem (TPBVP) with one endpoint that is 
free in time. An iterative approach can be employed to solve 
this problem, solving the state and costate equations during 
every iteration, in order to find the initial costate vector that 
meets the problem specifications and optimality conditions. 
Scrivener and Thompson [60], in their literature survey of 
work in this area, discuss a number of different techniques 
used to approach this problem. Additional iterative tech- 
niques for solving the TPBVP using linear programming or 
the shooting methods can be found in [61, 62]. Amore recent 
approach called switch-time optimization (STO) is dis- 
cussed in [63]. 

Although solution techniques are numerically complex 
and unreliable, many researchers have set these processes to 
the task of deriving time-optimal commands for nonlinear 
systems. Schiller [64—67], for example, derived commands 
for a nonlinear multi-link robot and incorporated additional 
constraints such as joint motion limits and obstacle avoid- 
ance. Liu and Singh [68] used Meier’s STO process to derive 
time-optimal commands for nonlinear systems with 
improved robustness to parameter uncertainties. Additional 
examples of time-optimal commands for nonlinear systems 
can be found in [69, 70]. 

2.3.3 Time- Optimal Control of Linear Systems 

When concerned strictly with linear, time-invariant 
systems, the claims that can be drawn from Pontryagin’s 
Minimum Principle can be further strengthened. First, as 
long as the desired final state can be reached by an input 
command that remains within the actuator limits, the time- 
optimal control for a linear system will exist and be unique. 
Second, the three general conditions that the time -optimal 
control must satisfy are not only necessary, as was the case 


10 

for nonlinear systems, but they are also sufficient. With these 
statements, it can be safely postulated that, if any command 
profile satisfies the three conditions outlined in Pontryagin’s 
Minimum Principle, it must necessarily be the unique time- 
5 optimal control solution for a given system. 

Given these powerful assertions about the nature of 
time-optimal commands for linear systems, some generali- 
zations can be made about the shape of time-optimal com- 
mand profiles. As dictated by the Bang — Bang Principle, 
10 any time-optimal command for a linear system must saturate 
the system actuators from the initial time of the command 
until the time that the system reaches its desired final state. 
After this terminal time, the time-optimal command must 
then adopt the profile required to maintain the system at its 
15 desired final state. For systems that have poles and no zeros 
after the final switch, the time-optimal command must 
necessarily remain at a constant value. More specifically, if 
the system has any rigid-body poles, the final value of the 
command must be zero, and if there are no rigid-body poles, 
20 the final command value must be set to the level required to 
keep the system at its desired terminal state. The profile of 
a typical time-optimal command for a system with just poles 
and no zeros is shown in FIG. 6. 

When a system has zeros as well as poles, the profile of 
25 the time-optimal command is somewhat different. Again, the 
Bang — Bang Principle requires that the command saturate 
the system actuators from the initial time to the time that the 
system reaches its desired final value. However, the profile 
of the command after this final time can now adopt a wider 
30 range of possible values. The only requirement for this 
portion of the command is that it maintains the system at its 
desired final state. Consequently, since the system has zeros 
as well as poles, any command profile that has the appro- 
priate initial conditions and drives the system strictly at the 
35 frequencies of the system zeros will not influence the system 
output. As a result, any command profile that is a linear 
combination of the initial condition response at the frequen- 
cies of the system zeros will be a potential candidate for the 
terminal component, or tail, of the time-optimal command 
40 profile. An example of a typical time-optimal command 
profile for a system with poles and zeros is shown in FIG. 
7. As illustrated, this command has two components: (1) a 
pulse train which delivers the system output to its desired 
final value, and (2) a tail which maintains the system output 
45 at its desired final value. Since the tail of the time-optimal 
command provides an additional degree of flexibility in the 
possible solution space of the optimal command profile, 
commands designed for both poles and zeros can often result 
in much shorter system response times than commands 
50 designed for poles alone. 

Both the time-optimal command for a system with poles 
and the time -optimal command for a system with poles and 
zeros contain a pulse train with a finite number of switches. 
Although the exact number of switches in this pulse train is 
55 not always known, some general statements can be made to 
bound the possible number of switch times. By convention, 
the number of switches refers to the number of times the 
command profile transitions between the upper and lower 
actuator limits; the transitions at the initial time and the 
60 terminal time are ignored. First, for the case where the 
system under consideration has only real or rigid-body poles 
and no zeros, the number of switches in the time-optimal 
command profile is exactly equal to n-1, where n is the 
number of system poles. If the system has complex poles as 
65 well as real and rigid-body poles and no zeros, the number 
of switches in the time-optimal command will be finite and 
have a lower bound of n-1. In general, the exact number of 



US 6,694,196 B2 


11 

switches in the time -optimal command for systems with 
complex poles will depend on the desired state change; the 
larger the state change, the more switches that will be 
required in the time-optimal command. For systems with 
zeros, the minimum number of switches required in the 
time -optimal command can be reduced by one for every zero 
in the system. For example, for a system with real poles, 
rigid-body poles and zeros, the minimum number of 
switches is (n-l)-r, and the maximum number of switches is 
n-1, where n is the total number of system poles and r is the 
total number of system zeros. For systems with complex 
poles as well, the lower bound on the number of switches is 
(n-l)-r, and the upper bound is finite but dependent on the 
desired state change. 

By applying these general principles about the nature of 
time-optimal commands for linear systems, several 
researchers have made some important insights about time- 
optimal command solutions for specific types of systems. In 
some early work, Barbieri [71] and Dodds [72] looked at 
linear systems with a single undamped flexible mode and 
made general statements about finding values for the com- 
mand switch times without using complex numerical search 
routines. Pao [73] investigated systems with damped flexible 
modes and outlined basic properties as well as a set of 
algebraic equations that the time-optimal commands must 
satisfy. Investigating new strategies for deriving time- 
optimal commands for linear systems with multiple flexible 
modes, several researchers [74-80] have proposed tech- 
niques for deriving time-optimal commands by solving a set 
of algebraic constraint equations. These algebraic constraint 
equations were formulated by making some general insights 
about symmetry properties of the time-optimal commands 
and the mathematical interpretation of the problem boundary 
conditions. 

Building on the initial developments about deriving time- 
optimal commands for systems with flexibility, several 
researchers also proposed techniques for extending this 
work to derive time-efficient commands with more desirable 
properties. In particular, several researchers [68, 81-84] 
proposed methods for including additional constraint equa- 
tions into the time-optimal formulation in order to derive 
robust, time-optimal commands. The resulting command 
profiles still displayed a bang — bang shape, but included 
additional switches and a longer overall time to better 
tolerate systems with dynamic uncertainty. An example of a 
robust, time-optimal command profile is shown in FIG. 8. 
Following a similar approach, researchers [85-89] have also 
explored ways to incorporate fuel-usage constraints in order 
to create time-efficient command profiles with better fuel- 
usage characteristics. These fuel/time-optimal command 
profiles, like the one shown in FIG. 9 , displayed a typical 
bang — bang nature but also contained idle periods between 
the actuator pulses. Lastly, researchers [90-93] have also 
explored techniques for adding smoothness constraints to 
typical time-optimal bang — bang profiles. The resulting 
near-time -optimal commands, while no longer retaining the 
bang — bang profile, excited less vibration in the structure 
upon implementation. 

Although focused almost exclusively on systems with 
solely flexible modes, the techniques developed in the past 
fifteen years for deriving time-optimal command share some 
similarities that deserve note. First, largely due to the 
complexity of numerical and iterative approaches for solv- 
ing this problem, much of the recent work in this area has 
focused on making statements about the general nature of 
optimal commands in order to reduce the size of the solution 
space. From these insights, researchers have developed 
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algebraic equations that relate the properties of the time- 
optimal command to specific problem constraints such as 
zero residual vibration. Because of the simplicity of these 
resulting equations, some analytic solutions for very simple 
5 systems have been proposed. More importantly, it has been 
illustrated that these algebraic constraints can be solved 
effectively using an optimization process. Furthermore, 
since optimizations are not always guaranteed to yield a 
global optimal solution, some researchers [77, 94-96] have 
10 proposed a simple method for verifying the optimality of 
command profiles using the conditions from Pontryagin’s 
Minimum Principle. This new approach, which combines an 
optimization of algebraic constraint equations with a simple 
optimality verification scheme, has been illustrated, for the 
15 case of systems with flexible modes, to deliver solutions 
much faster and more reliably than conventional iterative 
solution methods. 

2.4 Input Shaping 

First proposed by Singer and Seering in 1989 [97, 101], 
20 input shaping is a technique for shaping system commands 
to suppress unwanted system vibration. Due to its simplicity 
and effectiveness, even in the face of substantial system 
uncertainty, this technique has seen widespread use and 
development in the past decade. Originally developed as a 
25 method for filtering input command profiles in real-time, 
researchers have extended this work in many directions. 
Most recently, due to similarities in the command structure 
between input shaping commands and time-optimal 
commands, researchers have applied the basic principles of 
30 input shaping to the task of creating time-optimal command 
profiles. 

The purpose of this section is to present an overview of 
input shaping research performed in the past decade with 
particular attention toward advances made in addressing the 
35 time-optimal control problem. This section begins with a 
discussion of the basic theory of input shaping followed by 
a survey of the various extensions that have been made to 
this theory since its conception. Since the popularity of this 
technique is largely a measure of its effectiveness, an 
40 attempt will be made to mention many of the recent appli- 
cations of input shaping that have been reported in the 
literature. Given this overview of the theory and use of input 
shaping, this section will then turn to the time-optimal 
control problem and outline the work that several research- 
45 ers have done to apply input shaping techniques to solve this 
fundamental problem. 

2.4.1 The Basic Theory of Input Shaping 

In its basic form, input shaping is a strategy for shaping 
command inputs by convolving them with a sequence of 
50 impulses. The sequence of impulses, called the input shaper, 
is selected based on information about the system modes of 
vibration. For the case when a step command is shaped using 
an input shaper, the resulting command profile is a staircase, 
as shown in FIG. 10 . This shaped command, if designed 
55 correctly, will deliver the system from its initial value to its 
desired final value without exciting unwanted system vibra- 
tion. Since this approach relies on impulses, or sharp 
changes in the command profile, the resulting commands are 
very time -efficient and can typically deliver the system to its 
60 destination faster than many other methods. 

Much of the value in the input shaping approach resides 
in its simplicity. Typically, input shapers are designed by 
solving a set of algebraic constraint equations. These alge- 
braic equation are derived from the fact that the system must 
65 have zero residual vibration and can be solved analytically 
for some simple systems. The result of these analytic solu- 
tions are a set of special purpose impulse sequences that can 
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be implemented readily in a variety of systems with flex- 
ibility. Much of Singer’s original work [97-101], in addition 
to thoroughly investigating the basic theory and its 
properties, focuses on these basic impulse sequences that are 
highly effective at eliminating unwanted vibration in sys- 
tems with a single flexible mode. Additional work by Hyde 
[102-104], as well as Singer, looks at numerical approaches 
for deriving input shapers for systems with multiple modes. 
These approaches typically rely on an optimization routine 
to solve a set of nonlinear algebraic equations, and results 
have demonstrated input shapers can be derived quickly and 
reliably for systems with up to around six to ten modes of 
vibration. 

The concept of using correctly timed staircase profiles to 
create commands that eliminate unwanted vibration, 
although fully explored by Singer, was originally presented 
by Smith [105, 106] about forty years ago. Known as 
posicast control, this technique presented guidelines for 
timing the transitions in a staircase command profile using 
knowledge about the system vibration modes. Since its 
original presentation, many researchers [107-111] have 
illustrated that these commands can produce time-efficient 
and vibration-free motion in flexible mechanical systems. A 
primary advantage of Singer’s input shaping over posicast 
control is the use of robustness constraints to yield com- 
mands that can still perform effectively in the face of system 
uncertainty. The robustness constraints rely on taking the 
derivative of an analytic expression for system residual 
vibration and yield command profiles with a longer time- 
length but better tolerance to system uncertainty. Because of 
this inherent robustness, input shaping has seen much suc- 
cess when applied to a wide class of flexible systems with 
varying degrees of uncertainty. 

One way to gain insight into the principles and operation 
of input shaping is to consider its interpretation in several 
different domains. FIG. 11 offers a schematic of how input 
shaping can be interpreted in four different domains: (1) the 
time domain, (2) the frequency domain, (3) the Laplace 
domain, and (4) the discrete domain. For the purposes of this 
discussion, consider a step command shaped by an input 
shaper consisting of two impulses in the time -domain. The 
resulting shaped command, which is a two-step staircase, 
can then be applied to either an open- or closed-loop flexible 
system to produce output motion without residual vibration. 
In the frequency domain, the input shaper resembles a notch 
filter. If the magnitudes and the times of the impulses in the 
sequence are selected correctly, this notch will align with the 
resonant frequency of the system, and the resulting shaped 
command will excite little vibration at this mode. In the 
Laplace domain, the input shaper contains an infinite num- 
ber of zeros placed at periodic intervals along the imaginary 
axis. If the shaper is designed correctly, the lowest frequency 
zeros of the shaper will rest at the identical location of the 
system complex poles. Since these shaper zeros cancel the 
system poles, the system response will display no vibration 
at the canceled mode. By selecting a sampling interval 
coincident with the impulse spacing in the input shaper, a 
discrete domain representation can also be formulated. As 
shown in FIG. 11, the input shaper is comprised of a pair of 
complex zeros and an equal number of poles at the z-plane 
origin. As in the Laplace domain, when designed correctly, 
these zeros exactly cancel the system poles, resulting in a 
system response with no problematic vibration. 

Now, in the case where input shaping is designed with 
enhanced robustness, the same multi-domain interpretation 
can also be applied. In the time-domain, robust input shapers 
typically require more impulses in the shaper and produce a 
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staircase command with more steps. This results, in the 
frequency domain, in a notch filter with a wider notch. In the 
Laplace and discrete domains, this enhanced robustness is 
manifested by the presence of additional zeros located at or 
5 near the frequencies of the system poles. Typically the 
number of zeros in the shaper and their proximity to the 
system poles can be used to tailor the level of robustness 
required in a given system. 

2.4.2 Extensions to the Input Shaping Theory 
10 Research in the past decade has led to many extensions of 
the basic input shaping theory in many different research 
areas. These areas of active research include: (1) developing 
new techniques for deriving shaped inputs, (2) proposing 
different strategies for tailoring the command robustness to 
15 system uncertainty, (3) implementing input shaping in an 
adaptive framework, (4) proposing new kinds of constraints 
on shaper performance such as system deflection and fuel 
usage, and (5) applying input shaping techniques to improve 
trajectory tracking. This section will attempt to give an 
20 account of much of the work that has been performed in 
these areas to date. 

Perhaps the most active area of input shaping research in 
recent years has been in the realm of new derivation strat- 
egies for shaped commands and impulse sequences. Many 
25 researchers have explored a range of new derivation tools as 
well as proposed new types of sequences for reducing 
vibration in flexible systems. In particular, several research- 
ers have proposed strategies for using zero-placement in the 
discrete domain [112-114] as well as the Laplace domain 
30 [115-117] for deriving input shapers for both single- and 
multiple -mode systems. Additionally, researchers such as 
Singhose and Rappole have investigated specific classes of 
shaped commands and proposed analytic expressions and 
design heuristics to aid in the derivation of certain types of 
35 impulse sequences [118-125]. By building on a representa- 
tion proposed by Singer [99] called vector diagrams, Sing- 
hose described new strategies for deriving impulse 
sequences using graphical methods [126-129]. By modify- 
ing constraints to allow for negative impulses, Rappole and 
40 Singhose have also illustrated that shaped commands can be 
shortened for some systems and still effectively suppress 
unwanted vibration [130, 131]. Crain and Singhose have 
investigated properties of two-mode shapers and suggested 
guidelines for their construction [132, 133]. In recent work, 
45 Pao [134] presented new techniques for deriving input 
shapers for systems with multiple actuators, and Singhose 
[135] has applied neural nets to the task of creating input 
shapers. 

Another active area of research in the field of input 
50 shaping has been formulating new methods for improving 
the robustness properties of shaped commands. In a tech- 
nique proposed by Singer [136], a method was outlined for 
better controlling shaper robustness by explicitly specifying 
problem constraints at sampled frequencies in the frequency 
55 domain. In a related approach, Singhose [137, 138] pro- 
posed that command robustness could be better tailored to 
system uncertainty by designing input shapers that better 
place shaper zeros at and near problematic system frequen- 
cies. The resulting sequences, called multi-hump shapers, 
60 can then be incorporated into an optimization strategy to 
specify precisely the desired robustness of a given shaper 
[139, 140]. In more recent work, Pao [141] has suggested an 
approach for better tailoring input shaping robustness to 
known uncertainty in the damping and frequency of the 
65 flexible modes of a system. 

Although input shaping was originally developed for 
linear, time-invariant systems, many researchers have inves- 
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tigated adaptive implementations of input shaping to better 
apply the technique to systems with time-varying and 
configuration-dependent dynamics. In particular, Khorrami 
[142] employed a nonlinear controller and a single-mode 
shaper to eliminate vibration on a two-link flexible arm. In 
this approach, a real-time FFT process was used to identify 
system modes and update both the controller and shaper 
parameters adaptively. In a similar approach, Magee and 
Book [143-146] employed an adaptive approach to imple- 
ment a two-mode shaper on a two-link robot. Using analytic 
solutions combined with an interpolated lookup table, Rap- 
pole [118] proposed another method for implementing input 
shaping adaptively on a two -link flexible robot. Lastly, in 
work by Tzes [147-149], an adaptive input shaping scheme 
was presented that uses a non-collocated controller with 
acceleration feedback and a real-time frequency identifica- 
tion scheme. In this case and the others mentioned, input 
shaping was demonstrated to effectively produce the desired 
machine motion without residual vibration in the face of 
changing system modes. 

By appending the basic input shaping equations with new 
types of constraints, recent research has revealed that a 
variety of shaped commands can be created with certain 
desirable properties. For example, for some systems it is 
desirable to regulate the amount of deflection experienced 
by a system during motion. By incorporating this condition 
into the input shaping formulation, Banerjee and Singhose 
derived new types of deflection-limited shaped commands 
[150-153]. Similarly, in some systems with limited fuel, 
command profiles with better fuel usage characteristics are 
required. By modifying the command structure to include 
idle periods, Singhose developed a new class of shaped 
commands with desirable fuel-efficient properties 
[154-156]. Lastly, by combining both fuel-efficient com- 
mand characteristics with deflection limiting constraints, 
recent research has also revealed that commands can be 
created with both of these desirable properties [157, 158]. 

Although not specifically designed with the task of tra- 
jectory following in mind, the vibration suppression prop- 
erties of input shapers have led many researchers into 
investigating the effectiveness of shaped commands for 
tracking applications. Work in this area has revealed that 
certain types of shaped commands can yield better trajectory 
following performance in flexible systems than unshaped 
commands [159-162]. 

2.4.3 Applications of Input Shaping 

Due to its ease of implementation and robustness to 
system uncertainty, input shaping has been applied with 
much success to many types of open- and closed-loop 
systems. As an area of particular interest, many researchers 
have investigated the interaction of shaped commands with 
closed-loop control methodologies. Specifically, by apply- 
ing input shaping to a controlled two-link flexible robot arm, 
Hillsley and Yurkovich [163, 164] noted that the use of input 
shaping with an endpoint-feedback controller provided 
superior performance over each technique alone. Similarly, 
Khorrami [165, 166] noted that, when combined with a 
nonlinear feedback controller, input shaping proved effec- 
tive at enhancing the performance of another two-link 
flexible robot. Lim [167] also demonstrated success when 
integrating input shaping with high-performance control. 
Finally, although input shaping was designed to be a strictly 
feedforward technique, several researchers [168-172] have 
shown enhanced system performance when a shaper is 
included inside the feedback loop. 

Out of the many possible applications for input shaping, 
two primary application areas that have benefited from input 
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shaping techniques are flexible robots and flexible space 
structures. For example, in two early applications, Christian 
[173] and Yurkovich [174] demonstrated the effectiveness of 
the technique on multi-link flexible robots. Magee and Book 
5 [175, 176] also applied input shaping with success to reduce 
vibration in a Schilling manipulator. In the area of flexible 
space structures, Singh [177, 178] demonstrated ways to 
reduce vibration in 3-D slewing maneuvers of flexible 
spacecraft by applying input shaping. Additionally, Banerjee 
10 [179] successfully implemented input shaping on a model of 
a long spaced-based antenna, and Chang [180] collected 
experimental results from a satellite testbed in 1-g. In more 
recent experimental work, Tuttle [181] demonstrated the 
effectiveness of input shaping on space-based systems by 
15 collecting data from an experimental testbed flown aboard 
the Space Shuttle Endeavour in March of 1995. 

In addition to flexible robots and space structures, input 
shaping has seen implementation on a variety of other 
system types. Some of the applications that have been 
20 reported in the literature are summarized here. In order to 
eliminate measurement-corrupting vibration in coordinate 
measuring machines, several researchers [182-187] have 
enlisted input shaping. Additionally, input shaping has also 
seen success when applied to cranes for eliminating swing- 
25 ing in the payload during operation [188, 189]. As a testa- 
ment to the wide applicability of this technique, researchers 
have demonstrated success when using input shaping with 
such applications as force control [190, 191], spherical 
motors [192], and fluid -pouring systems [193]. Other 
30 examples of input shaping applications can be found in 
[194-197]. 

In addition to applying input shaping to a wide class of 
systems, several researchers have drawn comparisons 
among input shaping techniques and other feedforward 
35 control approaches. For example, some results presented by 
Bhat [41] compared input shaping, optimal-control 
techniques, and Fourier synthesis and concluded that all 
techniques were effective at reducing system vibration since 
they placed the shaped command zeros at the system poles. 
40 Kwon [198] and Rattan [159] also drew some comparisons 
between input shaping, digital filtering, and inverse 
dynamics, and Wie [199] looked at the performance of input 
shaping versus closed-loop techniques. In other work, Pao 
[200] and Singhose [201] made comparisons among dififer- 
45 ent input shaping techniques, and Singer [98, 202], Singhose 
[203], and Bodson [204] compared input shaping to digital 
filtering. Research results revealed that, although input shap- 
ing is inherently a digital filtering technique, conventional 
digital filters, since they are not intended for mechanical 
50 systems, cannot equal the performance of input shapers. 
2.4.4 Input Shaping and Time-Optimal Control 

In Singer’s original formulation, input shaping was 
intended to be used for shaping arbitrary actuator commands 
with a sequence of impulses. Because the impulses in this 
55 sequence were constrained to be positive in amplitude, the 
resulting transfer function of the shaped command, in addi- 
tion to having reduced energy at the system natural 
frequencies, was guaranteed never to exceed unity gain. 
Consequently, the resulting shaped commands had the desir- 
60 able property of eliminating residual vibration in the mod- 
eled system modes while not exciting unwanted vibration in 
unmodeled system modes. By relaxing the constraint that 
impulse amplitudes be positive, Singer [99] illustrated that 
shorter commands could be derived that still cancelled 
65 vibration at the modeled system modes. Singhose [205, 206] 
further demonstrated that the same input shaping constraint 
equations could be used to derive bang — bang command 
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profiles for flexible systems. By comparing these bang — 
bang commands to traditional time-optimal command 
profiles, it was revealed that they were indeed time-optimal 
[207, 208]. From this work, it became clear that the input 
shaping equations and solution approach, arguably more 
simple than conventional techniques, could now be used to 
derive time-optimal commands for linear systems with flex- 
ible modes. 

In addition to providing a much more convenient proce- 
dure for finding time-optimal commands, the similarities 
between input shaping and time-optimal control suggested 
possible methods for enhancing the performance of time- 
optimal commands. In particular, by applying the same 
robustness strategies originally developed for input shaping 
to time-optimal commands, researchers [95, 209-211] illus- 
trated that time-optimal command profiles with improved 
robustness could be derived easily. Work by Pao and Sing- 
hose [207] also revealed that the robust, time -optimal com- 
mand for a certain system was equivalent to the time- 
optimal command for the same system augmented with 
additional poles at the system modes of vibration. 
Furthermore, by adapting input shaping insights to the 
time-optimal control problem, Singhose [212] developed 
new methods for creating time -optimal commands with 
better fuel-usage properties, and Pao [213] proposed a 
simpler analytic procedure for creating bang — bang com- 
mands that were near time-optimal. 

2.5 The Next Step 

As the profusion of research outlined herein indicates, 
considerable work has been done in the area of feedforward 
control, and, in particular, in the area of creating time- 
optimal and time-efficient commands. In the case of time- 
optimal control, many processes have been developed for 
deriving command profiles for a wide range of systems. 
Built on the strength of Pontryagin’s Minimum Principle, 
these approaches can be applied to many kinds of linear and 
nonlinear systems without loss of generality. Unfortunately, 
due the nature of the constraints in Pontryagin’s principle, 
iterative search routines can be numerically intensive and 
solutions can be elusive. Largely due to this inherent 
complexity, these types of solution approaches have seen 
limited application on complex systems. More recently, as a 
product of research in the area of flexible systems, new 
methods have been presented for creating time -optimal 
commands for systems with flexible modes. In these 
techniques, researchers developed new types of algebraic 
constraint equations that allowed for easier solution of the 
time-optimal control problem for some simple linear sys- 
tems with flexibility. Following a similar strategy, but 
approaching the problem from a different field of research, 
input shaping has recently proven effective for creating 
time-optimal command profiles as well. Originally designed 
to suppress residual vibration in flexible systems, the input 
shaping theory relies on solving a set of constraint equations 
that describe the vibration characteristics of the system. 
Using these same equations, but with different requirements 
on the command amplitude, input shaping has yielded 
time -optimal solutions for linear systems with flexibility. 
This approach, since it relies on a set of simple algebraic 
equations, is both numerically and conceptually simple and 
has been demonstrated to effectively reduce vibration in 
many different types of systems. Furthermore, since the 
technique can be easily augmented with additional 
constraints, many researchers have successfully developed 
time-efficient commands with a range of enhanced qualities, 
such as improved robustness and fuel efficiency. 

Research in the past half-century has made considerable 
progress investigating the creation of time-optimal and 
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time-efficient commands. General but complex processes 
have been proposed to solve the time-optimal control 
problem, and many simple solution strategies have been 
developed for systems with flexibility. What is yet 
5 unavailable, however, is a simple approach that can be 
applied with generality to virtually all types of linear sys- 
tems. Such an approach should combine the simplicity, 
practicality, and ease of implementation of input shaping 
with the generality and strength of Pontryagin’s Minimum 
Principle 

SUMMARY OF THE INVENTION 

The present invention addresses the foregoing needs by 
providing a new and practical approach for deriving time- 
optimal and time -efficient command profiles for virtually all 
15 types of linear systems. The invention is general enough to 
apply to a wide class of systems, yet simple enough to allow 
for quick and effective solutions. The general solution 
framework can be summarized in the following three steps. 

Step 1 : Select a candidate command profile. Time-optimal 
20 and time-efficient commands represent a special sub- 
class of optimal command profiles designed to move 
systems rapidly from one point to another. As a result, 
they all have similarities in structure that can be lever- 
aged to better find a solution. Specifically, as above, 
25 time-optimal and time -efficient commands are typically 
comprised of a staircase or pulse train with a finite 
number of discontinuities. In some cases, namely for 
systems that have zeros, this pulse train or staircase can 
be followed by a tail made up of a sum of exponential 
30 terms. Due to this unique construction, the profile of 
these commands can typically be described completely 
by a small number of parameters. The solution space of 
these parameters, then, outlines the entire family of 
solutions for the optimal command profile. As is illus- 
35 trated below, navigating the solution space of possible 
command profiles using a small number of command 
parameters greatly reduces the computational complex- 
ity of this problem. As a result, solutions for time- 
optimal and time-efficient commands are easy to iden- 
40 tify and implement. 

Step 2: Impose the problem constraints. Given a param- 
eterized analytic expression for a candidate command 
profile, the next step toward finding an optimal solution 
is imposing the problem constraints. Typically, the 
45 problem statement, such as the time-optimal and time- 
efficient control problem statements outlined above, 
specifies the exact nature of the constraints required for 
a specific problem. These constraints, however, are 
most commonly expressed as conditions on the system 
50 performance in response to an input command. For 
example, in the case of the time-optimal control 
problem, it is required that the system output transition 
by a specified amount and come to rest. In order to 
explore the solution space of possible command pro- 
55 files that meet these conditions, these constraints on the 
performance of the system output must first be trans- 
lated into constraints on the command profile itself. 
This expression of the problem constraints in terms of 
the parameters that describe the input command is very 
60 much at the heart of this approach. Below, it will be 
illustrated how a minimum set of constraint equations 
can be derived to bound the optimal solution space. As 
will be discussed, these equations are algebraic and of 
manageable complexity and, consequently, allow for 
65 rapid and reliable solution. 

Step 3: Solve and verify. Given a family of candidate 
command profiles and a set of properly formulated 
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constraints that structure the solution space, the only 
remaining problem is solving the constraints to find the 
optimal solution. For some very simple systems, the 
problem constraints can be solved analytically to yield 
an optimal command profile. In most cases, however, 
solution requires a numerical optimization. Since opti- 
mization processes can be vulnerable to suboptimal 
local minima, an effective solution strategy should also 
provide a means for verifying the optimality of the 
result. As set forth below, by using conditions pre- 
scribed by Pontryagin’s Minimum Principle, not only 
can solutions for time-optimal and time-efficient com- 
mands be derived quickly and reliably, by they can also 
be verified as optimal for certain classes of problems. 

In more detail, according to one aspect, the present 
invention is directed to a system (i.e., a method, an 
apparatus, and computer-executable process steps) for deter- 
mining an input command profile for a dynamic system that 
can be modeled as a linear system, where the input com- 
mand profile is used to transition an output of the dynamic 
system from one state to another state. The invention iden- 
tifies characteristics of the dynamic system, and selects a 
command profile which defines an input to the dynamic 
system based on the identified characteristics. The command 
profile comprises one or more pulses which rise and fall at 
switch times and is useable with substantially any dynamic 
system that can be modeled as a linear system. The invention 
then imposes a plurality of constraints on the dynamic 
system, at least one of which is defined in terms of switch 
times. Thereafter, the invention determines the switch times 
for the input to the dynamic system based on the command 
profile and the plurality of constraints 

According to another aspect, the present invention is a 
system for determining an input command profile for a 
dynamic system that can be modeled as a linear system, 
where the input command profile is used to transition an 
output of the dynamic system from one state to another state. 
The invention includes selecting a command profile for the 
input to the dynamic system, where the command profile 
comprises a pulse train with pulses that rise and fall at switch 
times and is useable with substantially any dynamic system 
that can be modeled as a linear system. The selecting step 
comprises setting pulse train amplitudes based on actuator 
limits, determining if there are any system zeros and, if so, 
including a tail in the command, making an initial guess for 
the switch times, and, in a case that there are system zeros, 
making an initial guess for coefficients defining the tail. 
Thereafter, the invention imposes constraints on the system, 
which constraints comprise one or more of dynamics can- 
cellation constraints, boundary condition constraints, and, in 
a case that there are system zeros, actuator limit constraints. 
The switch times are then solved for based on (1) the 
command profile selected in the selecting step, (2) the initial 
guess for the switch times, (3) in a case that there are zeros 
in the system, the initial guess for the coefficients defining 
the tail, and (4) the problem constraints imposed above. 
Finally, the invention determines whether the switch times 
define an input which makes the command profile time 
optimal. 

This brief summary has been provided so that the nature 
of the invention may be understood quickly. A more com- 
plete understanding of the invention can be obtained by 
reference to the following detailed description of the pre- 
ferred embodiment thereof in connection with the attached 
drawings. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 illustrates the feedforward control problem graphi- 
cally. 

FIG. 2 illustrates the problem addressed by the present 
5 invention. 

FIG. 3 illustrates the time-efficient control problem 
graphically. 

FIG. 4 illustrates the time-optimal control problem 
graphically. 

10 FIG. 5 shows a typical time-optimal command. 

FIG. 6 shows a typical time-optimal command for a 
system with poles. 

FIG. 7 shows a typical time-optimal command for a 
system with poles and zeros. 

15 FIG. 8 shows a typical robust time-optimal command. 

FIG. 9 shows a typical fuel/time -optimal command. 

FIG. 10 illustrates the process of generating a shaped 
command using input shaping. 

FIG. 11 illustrates input shaping in four different domains. 
20 FIG. 12 shows a computer system for implementing the 
invention. 

FIG. 13 shows the architecture of the computer system of 
FIG. 12. 

FIG. 14 shows a typical time-optimal command profile. 

FIG. 15 shows the dynamics cancellation requirement, 
wherein the input command has zeros that cancel the system 
poles. 

FIG. 16 shows an alternative illustration of the dynamics 
30 cancellation requirement. 

FIG. 17 shows the time-optimal control problem’s bound- 
ary conditions. 

FIG. 18 is another view of the boundary condition con- 
straint. 

35 FIG. 19 shows the actuator limits constraint. 

FIG. 20 shows time-optimal commands for nonminimum 
phase systems. 

FIG. 21a shows a spring-mass system having one rigid 
body pole; FIG. 21 b shows the s-plane plot for the transfer 
40 function of the spring-mass system; and FIG. 21c shows the 
time-optimal command profile for the spring-mass system. 

FIG. 22 shows the time -optimal command and response 
for the spring-mass system with one rigid body pole. 

FIG. 23a shows a dynamic system having one real pole; 
45 FIG. 23 b shows the s-plane plot for the transfer function of 
the dynamic system; and FIG. 23c shows the time-optimal 
command profile for the dynamic system. 

FIG. 24 shows the step command and response for the 
dynamic system with one real pole. 

FIG. 25 shows the time -optimal command and response 
for the dynamic system with one real pole. 

FIG. 26a shows a dynamic system having a pair of 
complex poles; FIG. 26 b shows the s-plane plot for the 
55 transfer function of the dynamic system; and FIG. 26c shows 
the time -optimal command profile for the dynamic system. 

FIG. 27 shows the step command and response for the 
dynamic system with the pair of complex poles. 

FIG. 28 shows the time -optimal command and response 
60 for the dynamic system with the pair of complex poles. 

FIG. 29a shows a dynamic system having one real zero 
and two rigid body poles; FIG. 29 b shows the s-plane plot 
for the transfer function of the dynamic system; and FIG. 
29c shows the time-optimal command profile for the 
65 dynamic system. 

FIG. 30 shows the pulse command and response for the 
system with one real zero and two rigid body poles. 
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FIG. 31 shows the time-optimal command and response 
for the system with one real zero and two rigid body poles. 

FIG. 32 a shows a spring-mass system; FIG. 32 b shows 
the s-plane plot for the transfer function of the spring-mass 
system; and FIG. 32c shows the time-optimal command 5 
profile for the spring-mass system. 

FIG. 33 shows the time-optimal command and response 
for the spring-mass system. 

FIGS. 34 a, 34 b, 34c and 34d show the system command 
and response for a pulse command and three different types 
of time-optimal (“TO”) commands. 

FIG. 35 shows a plot of a system’s residual response to 
dynamic uncertainty. 

FIG. 36 shows a pole-zero representation of the dynamic 15 
uncertainty. 

FIG. 37 characterizes system uncertainty by varying poles 
and zeros. 

FIGS. 38 and 39 show typical robustness or insensitivity 
curves for a dynamic system. 20 

FIGS. 40a, 40 b, 40 c and 40 d show a time-optimal com- 
mand and its insensitivity to variations in the poles and zeros 
of a dynamic system. 

FIGS. 41a, 41 b, 41 c and 41d show a time-optimal com- 2 s 
mand with enhanced robustness to variations in the complex 
poles of a system and the corresponding insensitivity curves. 

FIGS. 42a, 42 Z?, 42c and 42 d show a time-optimal com- 
mand with enhanced robustness to variations in the real and 
complex poles of a system and the corresponding insensi- 30 
tivity curves. 

FIGS. 43a, 436, 43c and 43d show time-optimal and 
time-efficient commands with varying tail lengths. 

FIG. 44 shows the insensitivity of commands with four 
different tail lengths to variations in the real poles of a 35 
system. 

FIG. 45 shows the insensitivity of commands with four 
different tail lengths to variations in the complex poles of a 
system. 

40 

FIG. 46 shows the insensitivity of commands with four 
different tail lengths to variations in the complex poles of a 
system. 

FIG. 47 shows computer-executable process steps for 
determining time-optimal and time-efficient commands. 45 

FIG. 48 shows a graphical user interface for use with the 
process of FIG. 47. 

FIG. 49 shows a process for verifying optimality of a 
time -optimal command. 

FIG. 50 shows hardware for the Middeck Active Control 50 
Experiment (MACE). 

FIG. 51 comprises two plots showing the MACE gimbal 
response to a step command. 

FIG. 52 comprises two plots showing the MACE gimbal 
response to a spline command. 55 

FIG. 53 comprises two plots showing the MACE gimbal 
response to an input shaper. 

FIG. 54 comprises two plots showing the MACE gimbal 
response to a time-optimal command designed for the first 60 
three flexible modes and no zeros. 

FIG. 55 comprises two plots showing the MACE gimbal 
response to a time -optimal command designed for the first 
four flexible modes and no zeros. 

FIG. 56 comprises two plots showing the MACE gimbal 65 
response to a time-optimal command designed for the first 
four flexible modes and the first four pairs of complex zeros. 


22 

FIG. 57 comprises two plots showing the MACE gimbal 
response to a time-optimal command designed for the first 
four flexible modes and the first four pairs of complex zeros 
with additional robustness at the first two system modes. 

DETAILED DESCRIPTION OF THE 
PREFERRED EMBODIMENT 

Initially, it is noted that the present invention can be 
implemented by processors which control the operation of 
many different types of dynamic systems, such as disk 
drives, CD players, robot arms, etc. For the sake of brevity, 
however, the routines comprising the present invention will 
be described as executing on a personal computer (“PC”) 
which controls an external dynamic system. 

FIG. 12 shows computing equipment for a PC on which 
the present invention is implemented. As shown, PC 1 
includes network connection 2 for interfacing to a network 
and fax/modem connection 4 for interfacing to other devices 
or dynamic systems (not shown). PC 1 also includes display 
screen 5 for displaying information to a user, keyboard 6 for 
inputting text and user commands, mouse 7 for positioning 
a cursor on display screen 5 and for inputting user 
commands, disk drive 9 for reading from and writing to 
floppy disks installed therein, and drive 10 for accessing data 
stored on CD-ROM or DVD. PC 1 may also have one or 
more local peripheral devices connected thereto, such as 
printer 11. 

FIG. 13 shows the internal structure of PC 1. As shown in 
FIG. 2, PC 1 includes memory 12, which comprises a 
computer-readable medium such as a computer hard disk 
and/or RAID (“redundant array of inexpensive disks”). 
Memory 12 stores data 14, applications 15, database 16, and 
operating system 17. In preferred embodiments of the 
invention, operating system 17 is a windowing operating 
system, such as Microsoft® Windows98; although the 
invention may be used with other operating systems as well. 
Among the applications stored in memory 12 is dynamic 
system control application 19, which stores code to imple- 
ment the present invention in the manner described below. 

PC 1 also includes display interface 20, keyboard inter- 
face 21, mouse interface 22, disk drive interface 24, drive 
interface 25, computer bus 26, RAM 27, processor 29, and 
printer interface 30. Processor 29 preferably comprises a 
microprocessor or the like for executing applications, such 
those noted above, out of RAM 27. Such applications, 
including application 19, may be stored in memory 12 (as 
noted above) or, alternatively, on a floppy disk in disk drive 
9. Processor 29 accesses applications (or other data) stored 
on a floppy disk via disk drive interface 24 and accesses 
applications (or other data) stored on a CD-ROM or DVD 
via drive interface 25. 

Application execution and other tasks of PC 1 may be 
initiated using keyboard 6 or mouse 7, commands from 
which are transmitted to processor 29 via keyboard interface 
21 and mouse interface 22, respectively. Output results from 
applications running on PC 1 may be processed by display 
interface 20 and then displayed to a user on display 5 and/or 
output to an actuator of a dynamic system via, e.g., fax/ 
modem connection 4. Display interface 20 preferably com- 
prises a display processor for forming images based on 
image data provided by processor 29 over computer bus 26, 
and for outputting those images to display 5 
3 Creating Time-Optimal Commands for Linear Systems 

Turning to dynamic system control application 19, this 
application comprises computer-executable process steps 
(i.e., code) to determine an input command profile for a 
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dynamic system that can be modeled as a linear system, 
where the input command profile is used to transition an 
output of the dynamic system from one point to another 
point. The application also includes code to identify char- 
acteristics of the dynamic system, and to select a command 5 
profile which defines an input to the dynamic system based 
on the identified characteristics. The command profile com- 
prises one or more pulses which rise and fall at switch times 
and is useable with substantially any dynamic system that 
can be modeled as a linear system. The application further 10 
includes code to impose a plurality of constraints on the 
dynamic system, at least one of which is defined in terms of 
switch times, and then to determine the switch times for the 
input to the dynamic system based on the command profile 
and the plurality of constraints 

The following outlines the general procedure used by the 
invention to generate time-optimal actuator command pro- 
files that transition a dynamic system from one rest state to 
another rest state as quickly as possible. In this process, it is 
assumed that the time-optimal command will deliver the 
system from a known initial rest state to a desired rest state 
without exceeding pre-specified actuator limits. 
Furthermore, it is assumed that the given system behavior 
can be represented by a linear system model. Given these 
assumptions, the procedure outlined above is followed to 
derive time-optimal commands. Once it has been shown 
how this procedure delivers reliable solutions to the time- 
optimal control problem, practical constraints are incorpo- 
rated into this framework to yield more desirable optimal 
command profiles. 

A complete description of the time-optimal solution 
approach for linear, SISO systems will be presented first. 
This presentation will follow the three-step framework 
above. In step one of this framework, a general parametric 
equation is defined to represent all candidate time -optimal 
command profiles. In the second step, a set of equations is 
determined to impose the constraints established in the 
problem statement. These equations comprise the minimum 
set of necessary constraints required to properly bound the 
time -optimal solution space. In the third and final step, 
recommendations are made for solving the constraint equa- 
tions in order to extract the desired time-optimal command 
profile for a given system. With these steps complete, the 
specific solution of the time-optimal control problem for 
systems with only denominator dynamics is determined. 
This particular solution proves to be extremely useful for its 
simplicity. Finally, following a brief discussion about the 
influence of nonminimum phase zeros on the nature of the 
optimal command profiles, an overview is presented of the 
equations and solution approach provided by the invention. 

3.1 Step 1: Select a Candidate Command Profile 

As discussed in section 2.3.3 above, Pontryagin’s Mini- 
mum Principle and the Bang — Bang Principle dictate that 
the time-optimal command profiles for linear systems nec- 
essarily have a certain structure. For systems with no zeros, 
this structure is a simple pulse train with a finite number of 
pulses. For systems with both poles and zeros, the time- 
optimal command consists of a pulse train followed by a tail 
that is a linear combination of the responses at the frequen- 
cies of the system zeros. FIG. 14 illustrates a typical 
time-optimal command profile for a system with any type of 
linear dynamics. As this figure suggests, the structure of this 
command can be described by a small number of parameters 
such as the switch times, the switch amplitudes and the 
amplitudes of the components in the tail. More accurately, 
by defining some variables to represent these values, an 
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analytic expression for a candidate time-optimal command 
profile can be written as 

n r (3.1) 

w(r) = Yj ajl(t - tj ) + Yj Cje z i {t ~ tn) l(t - t n ), 
j = o j= i 

where 

l(t) is the unit step command and 
a y = t lie amplitude of the steps in the pulse train, 
tysthe switch times of the pulse train, 

Cysthe coefficients of the exponential terms in the com- 
mand tail, 

Zysthe system zeros, 

n=the total number of switches, excluding the first, and 
r=the number of system zeros. 

Note that, since the values of the system zeros, z-, can be 
complex, the coefficients, c-, corresponding to these com- 
plex zero values must also be complex so that the value of 
20 the command, u(t), is purely real. Using the same notation 
defined above, the Laplace Transform of the candidate 
time-optimal command can be expressed as 



Given a linear system model, the number of system zeros, r, 
and their values, Zy, can be completely determined. Also, 
30 since the pulse train of a time-optimal command must 
always saturate the system actuators, the specified system 
actuator limits can be used to directly determine values for 
the step amplitudes, ay. Consequently, for a given time- 
optimal control problem, the only unknowns that remain in 
35 equations 3.1 and 3.2 are the number, n, and values of the 
switch times, t -, and the tail coefficients, c As the following 
sections illustrate, if the problem constraints can be 
expressed in terms of these unknown command parameters, 
a solution process can be employed to identify optimal 
40 values for the command profile. 

3.2 Step 2: Impose the Problem Constraints 

As outlined above, the time-optimal control problem 
places a strict set of constraints on system response to a 
time-optimal command profile. In order to understand how 
these constraints influence the selection of an optimal com- 
45 mand profile, they must first be expressed mathematically in 
terms of the parameters that define the input command. 
Additionally, to avoid over- or under-constraining the prob- 
lem solution, the resulting constraint equations should rep- 
resent the minimum set of necessary conditions required to 
50 characterize the desired time-optimal command solution. 
From the time-optimal problem statement, three distinct 
constraints can be identified. The first of these constraints 
requires that the system begin and end at a rest state. This 
constraint, labeled the dynamics cancellation constraint, 
55 necessitates that any dynamics excited by the time-optimal 
input command must also be canceled by the command by 
the time the system reaches its final value. The second 
constraint imposed by the time-optimal control problem 
requires that the boundary conditions be satisfied. In 
60 particular, this constraint specifies the initial time of the 
time-optimal command and demands that the time-optimal 
command transition the system output by the desired 
amount. The third and final constraint imposed by the 
time-optimal control problem necessitates that the time- 
65 optimal input command never exceed the system actuator 
limits. This constraint, for obvious reasons, is called the 
actuator limits constraint. 
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In the remainder of this section, algebraic expressions are 
derived to capture each of these three problem constraints. 

For each of these three cases, the exact intention of the 
constraint will be expressed mathematically and related to 
the parameters that define the candidate command profile in 5 
equation 3.1. Following this derivation, the resulting con- 
straint equations are then used to solve for the unknown 
values of the command profile that best satisfy the time- 
optimal control problem. 

3.2.1 The Dynamics Cancellation Constraint 10 

The dynamics cancellation constraint is largely respon- 
sible for the effectiveness of the solution approach outlined 
herein. Based on the intuitive concept of pole-zero 
cancellation, this section outlines how a powerful set of 
algebraic equations can be formulated to prevent time- 15 
optimal commands from exciting unwanted system dynam- 
ics. These equations, although general enough to apply to all 
types of linear systems, are simple enough to allow for fast 
implementation and solution. Furthermore, as illustrated by 
the detailed derivation in Appendix A, these equations can 20 
be shown to be necessary conditions for any time-optimal 
command profile. This section will proceed by first deriving 
the dynamics cancellation constraint equations for systems 
that have no repeated roots. Following this derivation, the 
more complex yet general equations for systems with 25 
repeated roots will be presented. For each derivation, the 
resulting equations will be presented in both standard math- 
ematical form as well as a convenient matrix notation to 
allow for easy implementation. 

3. 2. 1.1 The Dynamics Cancellation Constraint Equations for 30 
Systems with No Repeated Roots 

The dynamics cancellation constraint is a mathematical 
statement of fact that the time-optimal command must move 
the system from one point and bring it to rest at another 
point. Previous research [48, 105, 113-115, 146] in the area 35 
of flexible system control has noted that, for the case of 
flexible modes, this constraint can be implemented by 
designing an input command that has zeros at the complex 
system poles, as depicted in FIG. 15. More specifically, Bhat 
[41] writes, “the necessary and sufficient condition for zero 40 
residual vibration is that the Laplace transform of the 
time-bounded control input have zero component at the 
system poles.” This is an equivalent statement to the zero- 
vibration condition in Singer’s input shaping approach [97] 
and can be used to derive a set of constraint equations 45 
governing the optimal command solution. However, unlike 
traditional command shaping approaches, the work in this 
document will illustrate that the dynamics cancellation prin- 
ciple applies not only to oscillatory modes, but to real 
modes, rigid-body modes, and minimum-phase zeros as 50 
well. Furthermore, by performing a complex derivation of 
the linear system response to a time-optimal command, 
Appendix A demonstrates that the dynamics cancellation 
equations developed in this section are necessary conditions 
for the time -optimal control of a linear system. 55 

Another view of the dynamics cancellation requirement 
for optimality is illustrated in FIG. 16. In this illustration, the 
optimal input command for a given system, G(s), is gener- 
ated by filtering a step command using a shaper, D(s). In 
order to yield a shaped command, u(t), that matches the 60 
time-optimal command profile of FIG. 14, this shaper must 
necessarily be identical to the impulse response of the 
time-optimal command profile, where the time-optimal 
impulse response, d(t), is defined as the derivative of the 
time-optimal command, u(t), itself. In the ideal case, the 65 
time -optimal command would move the system output from 
one point to another instantaneously. Therefore, the most 


desirable system response would be the one that most 
resembles, in some sense, a step command. Given that the 
input to the shaper, in the context of FIG. 16, is also a step 
command, it can be argued that the time-optimal shaper, 
D(s), would be the one that exactly cancels the dynamics of 
the system, G(s). In general, finding a D(s) to exactly cancel 
G(s) is not often possible. However, since the time-optimal 
impulse response is the derivative of the time-optimal com- 
mand profile, u(t), it will necessarily contain a series of 
impulses. Additionally, for the case of systems with numera- 
tor dynamics, it will also contain a tail with dynamic 
components at the location of the system zeros. If designed 
correctly, the tail of a time-optimal command will cancel any 
system numerator dynamics by placing poles at the locations 
of the system zeros. This can be seen in equation 3.2, by 
observing that the value of U(s) is infinite when s is equal to 
the system zeros. The sequence of impulses from the pulse 
train of the time-optimal command, however, will have a 
Laplace Transform with an infinite number of zeros. If 
designed correctly, the time -optimal command can be con- 
structed to place some of these zeros at the system poles. The 
impulse response of the time-optimal command will be the 
one that has exactly one zero at every system pole. 

With this understanding, we will now proceed to derive 
the dynamics cancellation constraint equations for linear 
systems with no repeated roots. The goal of this derivation 
is to compose a set of simple equations that ensure that the 
time-optimal command has poles that cancel the system 
zeros and zeros that cancel the system poles. As described 
above, by properly constructing the tail of the candidate 
time-optimal command, the resulting command profile is 
automatically guaranteed to contain poles at the system 
zeros. The task at hand, then, is to fashion constraint 
equations that ensure that the time-optimal command also 
has zeros at the system poles. Since the location of the 
command zeros are determined by the switch times of the 
optimal command profile, these equations should provide a 
mathematically simple representation for relating the known 
system dynamics to the switch time values in the candidate 
time-optimal command. 

We will begin the derivation from the fact that, as 
described above, the impulse response, d(t), of the time- 
optimal command, u(t), must be designed to have zeros at 
the locations of every system pole: 

L{d(t)}\ s=p =D(s)l =pi =0, (3.3) 

for i=l, 2, . . . , m, where p,- is the i-th system pole, and m 
is the total number of system poles. This is equivalent to 
saying that the Laplace Transform of the derivative of the 
time-optimal command must have exactly one zero at each 
of the system poles: 

( d U (3.4) 

4 =i£/(s)U « =0 - 


By substituting the expression for U(s) from equation 3.2 
into this result, the following algebraic or, more specifically, 
trigonometric equation can be derived: 


X a J e ~ s,J +<r “"Z rr 


j = o 


j= i 



(3.5) 


for i=l, 2, . . . , m. This expression is the general form of the 
dynamics cancellation constraint for linear systems with no 
repeated roots. It expresses the requirement for rest-to-rest 
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motion in terms of the parameters that define the command 
profile. In order to properly constrain the search for a 
time-optimal command profile, this expression must be 
evaluated for every system pole, p t -, including real, complex, 
and rigid-body poles. For real and rigid-body poles, this 5 
expression will yield a single real-valued constraint. For 
complex pole pairs, this equation will yield the identical 
result for each complex-conjugate pole. This result, 
however, will have a complex value, and its corresponding 
real and imaginary parts must both be set to zero to properly 10 
enforce the constraint. 

To better facilitate the computer implementation of this 
dynamics cancellation requirement, a simple matrix expres- 
sion can be defined that imposes the constraint in equation 
3.5 for every system pole. Before this expression can be 15 
presented, however, a convenient set of vectors must first be 
defined: 


Pi 


s = 


P 2 


system poles, 


Pm 


a { 


a = 


a 2 


pulse train step amplitudes, 


(3.6) 

20 


(3.7) 

25 


are small. In this code, the values of all the constraints are 
returned in a vector. This vector, which can contain both real 
and imaginary components, must be completely zero for the 
command that satisfies the time-optimal control problem. 
Note that, since the constraint equations for complex pole 
pairs are identical, only one of the poles in the pair needs to 
be evaluated for the dynamics cancellation requirement. 
Also, since the dynamics cancellation constraint for the first 
system rigid-body mode is automatically satisfied by the 
correct selection of the pulse train amplitudes, it can also be 
ignored in constraint calculation. This point can be better 
seen by evaluating equation 3.16 for the rigid -body pole, 
that is, for s=0. 


TABLE 3.1 


Matlab code to implement the dynamics cancellation constraint 
for systems that have no repeated roots 


% Given the vectors, s, a, c, z, and t defined according to 
% equations 3.6 through 3.10, this code calculates the 
% dynamics cancellation constraints for systems with no 
% repeated roots and returns them in the vector dc_constr. 

% Any time-optimal command must necessarily yield a value 
% of zero for each of these constraints 
n = length(t); 

M = (l./(l-(l./s)*z))*c; 

dc_constr = exp(-s*t)*a + M.*exp(-s*t(n)); 


On 


Cl 


c = 


C2 


coefficients of the command tail, 


c r 


Z = \ Zi Zi ■ ■ ■ Z r ] system zeros, and 
t = [ t 0 ti ■ ■ ■ t n ] command switch times, 


(3.8) 


(3.9) 

(3.10) 


where, 

n=the total number of switches, excluding the first, 
m=the total number of system poles, and 
r=the total number of system zeros. 

Given these vector definitions, the matrix form of the 
dynamics cancellation constraint can be written as 


exp(-st)a+M.*exp(-st„)=Q, (3.11) 

where 

M=(l./(l-(l./s)z))c. (3.12) 

Note that, in these expressions, the function exp ( ) refers to 
the element-by-element exponential rather than the matrix 
exponential, the operator .* refers to the element-by-element 
multiplication, and the operator ./ refers to the element-by- 
element division. These equations can be easily entered into 
a linear algebra software package, such as Matlab [215], to 
evaluate the dynamics cancellation constraints. Substituting 
the vector definitions into these matrix equations and cal- 
culating the result will yield a column vector with m 
elements. Each of these elements represents the value of 
equation 3.5 evaluated at each of the m different system 
poles. 

An example of the Matlab code required to implement the 
above constraints is shown in Table 3.1. As this listing 
illustrates, only three lines of code are required. 
Additionally, since the equations are algebraic and imple- 
mented as vector operations, computational requirements 


3. 2. 1.2 The Dynamics Cancellation Constraint Equations for 
30 Systems with Repeated Roots 

For systems with repeated roots, the dynamics cancella- 
tion equations prove to be somewhat more complex, to 
express. Despite this added notational complexity, these 
equations still retain the computational simplicity of the 
35 equations for systems with no repeated roots. As a result, 
solutions derived using these equations can still be found 
quickly and reliably. Furthermore, due to their unique prop- 
erties in the Laplace domain, these constraints will prove 
valuable below for deriving time -efficient commands with 
enhanced robustness to system uncertainty. The derivation in 
this section will proceed by first developing the general 
mathematical equations and then a convenient matrix 
expression to impose this constraint. In order to illustrate the 
45 manageable implementation complexity of the result, an 
example of representative computer code to express these 
equations will also be presented. 

The dynamics cancellation constraint for systems with 
nonrepeated poles is given in equation 3.5. For systems that 
50 have more than one pole at a single location, there must be 
one unique constraint equation for every pole in the system. 
For the first pole at a location, equation 3.5 still applies. 
However, for additional poles, a new type of constraint is 
required. In general, for a system that has q T repeated poles 
55 at a single location, the required constraint equations for 
each of the poles are 


60 


65 


(3.13) 
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-continued 

= 0, 

5 

where U(s) is the Laplace Transform of the candidate 
time-optimal command, u(t), and p, is the value of the 
repeated system pole. By substituting the expression for 
U(s) in equation 3.2, we can rewrite these equations as 10 


(, sU(s )) 


30 


Again, for a third pole at s=p,-, q~3, equation 3.15 
becomes 


Z a i’) e ~ s ' i+ 

j = o 




c jZj o 2c JZj 2 cjzjj 

(s-Zj) n ( s-Zj? n (s-Zjf. 



pole 1: £ aje^J JLlL. = 0 


pole 2: Ts [X a P~* j + X 7TT- = 0 


By observing the pattern followed by this series of 
equations, insight can be gained about a general analytic 
15 expression that can capture all of these constraints. This 
expression can be written as follows: 


cf T 1 -st- -st V 1 c j s 

pole ^ : ■ /+c "X ttt: 


where the variables in this expression are defined as in 
section 3.1. Therefore, if a system has a pole of multiplicity 
3 at a certain location, p,., then three equations in this series 
must be used to properly specify the dynamics cancellation 
constraint for that pole location. 

Now, in order to implement these equations, the analytic 
solution for the multiple derivative in the dynamics cancel- 
lation constraint, as in the above equations, must be found 
This can be done more easily by placing the above equations 
in the form 


r Vi 

“"2 cjt ir 11 * 


-SK)] 


For a repeated pole of multiplicity q T , this expression must 
be evaluated q T times, once for every q ~1, 2, . . . , q T . In this 
equation, the variable p represents a function that deter- 
mines the value of the coefficient for the appropriate term in 
the equation. This function can be calculated recursively 
using the formula 

n, for k = 1 (3.17) 

M)= U tor k ± l 
P q .(k) = #.._! (*) + (*- 1) A-!(*-l)- 


Although not shown here, a little math will illustrate that this 
expression is identical to the ones in equation 3.14 for the 
case where q~l, 2, . . . , q T , where q f represents the 
multiplicity of each system pole, p f . For example, for a 
system with two identical poles, the first pole, p 1 , would 
have q 1 =l, and the second, p,-, would have q 2 =2. Any 
nonrepeated system poles would have q~l. Evaluating the 
derivative in this equation analytically yields equations of 
the following forms: 

For a single pole at s=p J ,-, that is for q~l, equation 3.15 
becomes 



Similarly, for a second pole at s=p,-, q~2, equation 3.15 
becomes 


40 Table 3.2 lists a range of values for this function (3 that were 
calculated using this formula. 

In order to correctly specify the dynamics cancellation 
constraints for a given system, equation 3.16 must be 
45 specified once for every system pole, p t -. In each equation, 
the value of q,- corresponding to each system pole must be 
used. As stated before, for nonrepeated system poles, q~l, 
and for repeated poles of multiplicity q T , q~l, 2, . . . , q T . 

50 TABLE 3.2 



Selected values for the function 1 
k = 1 k = 2 k = 3 k = 4 

k = 5 

k = 6 

Pi(k) 

1 

0 

0 

0 

0 

0 

kGO 

1 

1 

0 

0 

0 

0 

kCO 

1 

2 

2 

0 

0 

0 

fL(k) 

1 

3 

6 

6 

0 

0 

PsCO 

1 

4 

12 

24 

24 

0 

MO 

1 

5 

20 

60 

120 

120 


60 


X ^ stJ+e ' 

j= 0 



M 


c JZj 

(s~Zj) 2 



Given this general expression for the dynamics cancellation 
constraints that can accommodate systems with repeated 
roots, a matrix equation can be developed to allow for easy 
65 implementation. Specifically, by using the vector definitions 
in equations 3.6 through 3.10, the following equation can be 
defined: 
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exp(-5r)r (<7i l) a + 


at^r l) A^ qj {k)F^r k) h 


*exp(-sfj : 


(3.18) 


TABLE 3.3 


Matlab code to implement the full dynamics cancellation constraint 
for systems that can include repeated roots 


where the following definitions hold 

exp( )=element-by-element exponential of a matrix or 
vector, 

.( )selement-by-element math operation, 

Tsdiagonal matrix with the switch time vector, t, along 
the diagonal, 

j= i 

|3( ) is defined as in equation 3.17, 

— - — 1 
\ Pl - Zl Pl~ Z2 Pl-Zr 


% Given the vectors, s, a, c, z, and t defined according to 
% equations 3.6 through 3.10, this code calculates the complete 
% set of dynamics cancellation constraints and returns them 
% in the vector dc_constr. Any time-optimal command 
% must necessarily yield a value of zero for each of these 

10 % constraints. This code also requires the multiplicities of 

% each system pole to be stored in the vector q. 
dc_constr = [ ]; 
n = length (t); r = length (z); 

T = diag(t); 
alpha = sum(c); 

1 c beta = 1; 

h = c.*(z.'); 
for qi = l:max(q), 

ind = find(q>=qi); s = s(ind); q = q(ind); 

E = exp(-s*t); 

Etn = exp(-s*t(n)); 

F = l./(s*ones(l, r) - ones(length(s), l)*z); 

2U val = 0; 

for k = l:qi, 

val = val + (beta(k) * (F. k) * (t(n) (qi-k))); 

end; 

R = E*(T * (qi-l))*a + (alpha*(t(n A (qi-1)) + val*h).*Etn; 

dc_constr = [dc_constr; R]; 

25 beta = [beta 0] + [0 cumsum(ones(l, qi)).*beta]; 

end; 


1 


F = 


Pl-Zi 


, and 


1 


1 


Pm - Zl 


Pm-Zr 


ClZl 


h = c*z T 


C2Z2 


3.2.2 The Boundary Condition Constraint 

In addition to the dynamics cancellation constraints, the 
problem boundary conditions must also be established math- 
ematically. Specifically, for the time-optimal control 
problem, as illustrated in FIG. 17 , two boundary conditions 
are required. The first sets the initial time of the optimal 
command to zero and is trivial to implement: 

* o =0. (3.19) 


C r Zr 


For a system with poles all having the same multiplicity, q T , 
equation 3.18 can be evaluated once for every value of q i9 
where q,=l, 2, . . . , q T , to impose all of the necessary 
dynamics cancellation constraints. In general, all poles in a 45 
given system do not have the same multiplicity. In these 
cases, equation 3.18 must first be calculated for every pole 
with a multiplicity of 1, and then for only the poles of 
multiplicity 2, 3, etc. In order to aid this calculation, a 
multiplicity vector, q, can be defined. This vector contains 50 
the corresponding multiplicity value, q i , for every system 
pole, and, consequently is the same length as the vector s. 

For example, in a system with poles s=[-4 -6 -6] r , the 
corresponding multiplicity vector should be q=[l 1 2]. Using 
this definition, Table 3.3 lists a segment of Matlab code that 
is a possible implementation of equation 3.18 for systems 
with poles with different multiplicities. From this listing, it 
can be seen that the full implementation of the dynamics 
cancellation constraint for any kind of linear system requires 
less than twenty lines of code. Additionally since all of the 
calculations in this code are algebraic and can be expressed 
largely as vector operations, the computational requirements 
of this code are small. By incorporating this code, as well as 
the other problem constraints, into an optimization routine, 65 
solutions for the time-optimal command for any kind of 
linear SISO system can be found. 


The second boundary condition, which requires that the 
system output change by the desired amount, dy, is more 
complicated to express. In general, if the dynamics cancel- 
lation constraints are successfully satisfied by an optimal 
command profile, at the end of the pulse train of the optimal 
command, the system output, y(t), will remain at rest at 
some final value. The boundary condition constraint must be 
selected to ensure that this value agrees with the specified 
dy. One possible way to do this is simulate the time response 
of the system to the candidate optimal input command and 
impose the following constraint: 

y(Q=dy. (3.20) 

If this approach is used in a numerical optimization of the 
problem constraints, the system state -transition matrix 
would have to be calculated during every iteration. This 
55 numerically intensive procedure would likely result in unde- 
sirably long solution times. 

A better approach for expressing the second boundary 
condition is to use the Final Value Theorem [216] to derive 
a single expression relating dy to the unknown command 
60 parameters. This can be done as follows. First, from the 
system transfer function, an expression can be derived for 
the Laplace Transform of the output response, Y(s): 

Y(s) (3.21) 

jtA = G(s) => Y(s) = G(s)U(s). 
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Now, from the Final Value Theorem, 


In this case, equation 3.23 takes the following form: 


dy = lim (sG(s)U(s)). 

s-> 0 



(3.27) 


Substituting the expression for U(s) in equation 3.2 into this 
equation yields 


dy = 






(3.23) 


Due to the rigid-body poles in the system transfer function, 
this equation has a (1/0) term. Additionally, since the dynam- 
ics cancellation equation for the rigid-body pole, which can 
10 be derived from equation 3.5 for s=0, results in the expres- 
sion 


Now, in general, the system transfer function, G(s), can be 
rewritten in the form 

15 


X a ' =0 ’ 

j = o 


(3.28) 


G(s) = 


s rbz N(s ) 
s rb PD{s ) ’ 


(3.24) 


where rbp is the number of rigid-body poles, that is poles at 
the s-plane origin, in the system, rbz is the number of 
rigid-body zeros, that is zeros at the s-plane origin, in the 
system, and N(s) and D(s) contain only non-rigid dynamics. 
Depending on the number of rigid-body poles and zeros in 
the system, the solution of equation 3.23 can take on three 
different forms. Each of three cases will be considered 
independently: 

Case 1: G(s) has excess rigid-body zeros (rbz>rbp). 

In this case, applying the Final Value Theorem reveals that 
the final value of the system in response to the time-optimal 
command will always be zero. In general, if G(s) has any 
uncancelled zeros at the s-plane origin, it will be impossible 
to transition the output from one rest state to another using 
a bounded input. For example, for the case of a system with 
a single rigid-body zero, the type of command profile 
required to move the output to a new rest state is a ramp. 
Since this type of command will eventually exceed the 
system actuator limits, there is no time-optimal command 
that will satisfy the problem constraints. 

Case 2: G(s) has no rigid-body poles or zeros (rbz=rbp). 

In this case, equation 3.23 can be written in the following 
form: 


it can be seen that equation 3.27 will be indeterminate of the 
form (0/0). Since this is the case, U Hospital’s Rule [217] 
can be invoked to calculate the limit in equation 3.23. 

20 L’Hospital’s Rule states that if f(x) and g(x) are zero at x=a, 
then 


lim ^ ^ . (3-29) 

™g(x) g'(x) x=a 


This rule can be applied as many times as necessary to reach 
a determinate result. For very simple systems, L’Hospital’s 
Rule can be used to solve for the boundary condition 

30 constraints by hand. However, it is difficult to derive a 
general analytic expression for the solution of equation 3.23 
using this approach. A better approach, that is conceptually 
simpler, easier to implement in computer code, and numeri- 
cally comparable is the following. 

35 For a system with rbp rigid-body modes, 


G(s)= —t———, 
s’hPDis) 


(3.30) 


the Final Value Theorem can be used, as before, to relate the 
system dynamics and input command to the desired output 
response, dy: 



which then reduces to 



(3.25) 

45 


50 

(3.26) 


dy = lim (5 G(s) U(s)) 


v (N(s) 1 

= lim — — r- ■ 

s^0\D(s) s rb P 


= lim(— Vlimf 

s ->0 V D(s) > s-h >0 \ 


'*£/«) 


(3.31) 


Now, since by the Final Value Theorem, we know that the 
expression 


Therefore, implementing this constraint is straightforward. 55 
All that is required is that the sum of the step amplitudes 
multiplied by the transfer function steady-state gain is equal 
to dy. Since the transfer function steady-state gain can be 
readily determined from the given system model, this con- 
dition can be met by properly selecting the step amplitudes. 60 
More specifically, given that the values for all of the step 
amplitudes except the last, a n , must be set so that the 
command profile saturates the system actuators, their values 
are dictated by the given actuator limits. Consequently, 
equation 3.26 can be used to directly calculate the optimal 65 
value for a„ to meet the specified boundary conditions. 

Case 3: G(s) has excess rigid-body poles (rbz<rbp). 


, ( 1 ) (3.32) 

dv = lim ( 5 G\s) U(s)) = lim s- — ■ U(s) 

s-> 0 0 V S rb P ) 

implies that dv is the steady-state output of some system, 
G'(s), to the candidate time-optimal input command, u(t). As 
implied by equation 3.32, and illustrated in FIG. 18, this 
system has the transfer function 
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Following this logic, we can then combine equations 3.31 
and 3.32 to yield the simpler expression 


dy = lim. — — ) ■ dv. 

s->o\ D(s) / 


( 3 . 34 ) 


Now, since dv is the steady state output of a system that 
consists of a cascade of simple integrators to the input 
command, u(t), an expression for dv can be formulated as 
follows: 


/ rbp) I 

u{t)dt\ 


( 3 . 35 ) 


In other words, dv is equal to the rbp-th integral of the 
candidate command profile evaluated at t=oo. Given the 
block diagram in FIG. 15 , and the facts that ( 1 ) the transfer 
function N(s)/D(s) has no rigid-body poles or zeros and (2) 
the time-optimal command will move the system output, 
y(t), from one rest state to another, then it can be determined 
that dv will almost always approach some finite steady-state 
value as t goes to oo. Consequently, equation 3.35 will almost 
always yield a valid result. The only exceptions to this 
statement are the cases when the time-optimal command has 
a tail that has undamped or unstable oscillation. In these 
situations, the integral in equation 3.35 will not converge as 
t goes to oo. However, as will be discussed later herein, 
creating time-optimal commands with undamped or 
unstable oscillation is bad design practice and should not be 
implemented on a real system. 

Therefore, by combining equations 3.34 and 3.35, an 
expression for the second boundary condition can be final- 
ized: 


dy-- 


lim 

s->0 


SHf 


u{t)dt 


( 3 . 36 ) 


In order to implement this equation, all that is required is to 
take the limit of N(s)/D(s), which is trivial given the system 
transfer function, and to integrate u(t) from 0 to oo rbp times. 
To perform this integration, a numerical integration routine 
could be performed during the problem optimization, but 
this is very numerically intensive. Abetter approach is to use 
an analytic solution for the integral of the time -optimal 
command profile to calculate this expression. Appendix B 
hereto presents the derivation and resulting algebraic equa- 
tions that can be used to analytically evaluate this integral. 
These equations and their computer implementation are 
highly streamlined and require very little computational 
effort. 

3.2.3 The Actuator Limit Constraint 

The final constraint required to bound the solution space 
of the time-optimal control problem is perhaps the most 
straightforward to implement. This constraint, called the 
actuator limit constraint, ensures that the input command 
profile will not exceed the specified system actuator limits, 
as shown in FIG. 19 . For the case of a time-optimal 
command profile that contains no tail, the actuator limits are 
enforced by properly selecting the pulse train amplitudes to 
meet, but not exceed, the given actuator limits. When a tail 
is appended to the pulse train in the optimal command 
profile, a little more care must be taken to impose this 
constraint. Specifically, the second term in equation 3.1 can 
be used to calculate the profile of the tail during the solution 
of the constraint equations: 


36 


Utailit) = ^ C J £Zj{t ' n) l 
j= 1 


( 3 . 37 ) 


By requiring that the tail profile at all times remain within 
the actuator limits, an additional constraint equation can be 
formulated: 


10 




( 3 . 38 ) 


To implement this equation in an optimization routine, 
equation 3.37 must be evaluated over a reasonable time- 
length at some sampling interval. From the result, the 
maximum and minimum value of the command can be 
15 determined and constrained by equation 3.38. 

3.3 Step 3: Solve and Verify 

The three types of constraint equations derived in Step 2 
above comprise the minimum set of constraint equations 
required to determine the solution for a time-optimal com- 
20 mand profile. In some cases, for very simple systems, these 
equations can be solved analytically. Some of these solutions 
are outlined in section 4 below. However in most cases, the 
constraint equations are too complex to succumb to analytic 
solution and must be solved using an optimization process. 
25 The basic procedure for finding optimal commands begins 
by setting the values of the command amplitudes, a,-, from 
the given actuator limits and taking an initial guess for the 
command switch times, t f . A constrained optimization 
process, such as the one in the Matlab Optimization Toolbox 
30 [218], can then be used to search for the shortest set of 
switch times that satisfy equations 3.16, 3.19, 3.36, and 3.38. 
From the result, equation 3.1 can be used to calculate the 
profile of the time-optimal command. Although search times 
rely on the quality of the initial guess, they are typically on 
35 the order of seconds due to the simplicity of the constraint 
equations presented herein. 

Since optimization processes can be vulnerable to sub- 
optimal local minima, this solution approach cannot guar- 
antee that the time-optimal command will always be found. 
40 Fortunately, Pontryagin’s Minimum Principle provides a set 
of necessary and sufficient conditions to verify the optimal- 
ity of a given command profile. These conditions can be 
used to complement an optimization routine and ensure that 
the solution procedure presented above generally returns a 
45 time-optimal result. Section 6 below discusses both the 
solution approach and the verification process in more 
detail. 

3.4 The Reduced Equations for Systems with Only Poles 

As discussed in section 2.3.3 above, time-optimal com- 

50 mand profiles for systems with poles and zeros contain a 
pulse train followed by a tail. For systems that have only 
poles and no zeros, the tail is not required. As a result of this 
simpler command structure, the constraint equations for 
systems that contain only poles are far less complex than 
55 those for the more general case. Due to this simplicity, these 
reduced equations often prove useful for deriving quick 
solutions for many kinds of systems. For example, many 
systems can be modeled accurately using solely denomina- 
tor dynamics. When this is the case, the reduced equations 
60 should be used to derive the time-optimal command profile. 
Additionally, in some systems, such as ones with a high 
degree of dynamic uncertainty, the presence of a tail in the 
input command might be undesirable. In these cases, the 
system numerator dynamics can be ignored during com- 
65 mand derivation to produce a command profile with only a 
pulse train and no tail. This section will proceed by first 
presenting an expression for a candidate command profile 
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for a system with only poles. Based on this expression, the 
reduced form of the three problem constraints will be 
outlined, and an implementation and solution of these equa- 
tions will be provided. 

3.4.1 The Candidate Command Profile Equation 

For a system with only poles, the time-optimal command 
will consist of a pulse train. Consequently, the analytic 
expression to represent this family of commands is simply 


38 

where the notation is the same as in equation 3.18. For a 
system with poles all having the same multiplicity, q T , this 
equation can be evaluated once for every value of q,-, where 
q-=l, 2, . . . , q T , to impose all of the necessary dynamics 
5 cancellation constraints. For systems with poles of different 
multiplicities, the Matlab code in Table 3.4 can be imple- 
mented to impose the required dynamics cancellation con- 
straints. 


n 


«(0 = Yj ajl(r-tj), 

j = o 


(3.39) 


where the notation is the same as defined for equation 3.1. 
Similarly, taking the Laplace Transform of this expression 
yields the result 


U(s) 



aj€- st J. 


(3.40) 


3.4.2 The Dynamics Cancellation Constraint 

Following a similar approach as in section 3.2.1, the 
equations that describe the time-optimal command profile 
can be used to derive constraints that ensure rest-to-rest 
motion in the system output. This derivation relies on the 
fact the time-optimal command must have zeros at the 
locations of the system poles. Without going into the details 
of this derivation, the resulting reduced form of the dynam- 
ics cancellation constraint equations is presented below. 

3. 4.2.1 Dynamics Cancellation Constraint Equations for 
Systems with No Repeated Roots 

Using the same notation as in equation 3.5, the dynamics 
cancellation constraint for linear systems with only nonre- 
peated denominator dynamics can be stated as 


Z 


\J=° 


|s= P/ 


= 0 , 


(3.41) 


where this equation is evaluated at the value of every system 
pole, p,., for i=l, 2, . . . , m. Furthermore, by using the vector 
definitions in equations 3.6 through 3.10, this constraint can 
be expressed in a compact matrix notation: 

exp(-st)a= 0, (3.42) 

where exp( ) is the element-by-element exponential. This 
matrix expression yields a vector of constraint values with 
one value for every system pole. Not only is this expression 
computationally simple, but it can be expressed with a single 
line of Matlab code. 

3. 4.2.2 Dynamics Cancellation Constraint Equations for 
Systems with Repeated Roots 

For systems with repeated poles, the reduced form of the 
dynamics cancellation constraint takes on a slightly different 
form: 


Z 


J= o 



(3.43) 


For a repeated pole of multiplicity q T , this expression must 
be evaluated q T times, once for every q~l, 2, . . . , q T . In 
matrix notation, this equation can be written as 

exp(-st) 7^ i_1 )a=0, (3-44) 


TABLE 3.4 


Matlab code to implement the dynamics cancellation constraints 
for systems with just poles. 


% Given the vectors, s, a, and t defined according to 
% equations 3.6 through 3.10, this code calculates the 
% set of dynamics cancellation constraints for systems 
% with just poles and returns the result in the vector 
% dc_constr. Any time-optimal command must necessarily 
% yield a value of zero for each of these constraints. 

% This code also requires the multiplicities of 
% each system pole to be stored in the vector q. 
dc_constr = [ ]; 

E = exp(-s*t); 
for qi = l:max(q), 

R = E (find (q>=qi),:)*(T A (qi-l))*a; 
dc_constr = [dc_constr; R]; 

end; 


3.4.3 The Boundary Condition Constraint 

The boundary condition constraints for systems with only 
denominator dynamics remain largely the same as the gen- 
eral expressions in equations 3.19 and 3.36: 

t= 0, (3.45) 

and 


35 


dy = lim/^^V 
7 s->o V D{s) / 


( (rbp) 

f 




(3.46) 


The only difference in these equations is the evaluation of 
40 the integral of the time-optimal command profile. As dis- 
cussed in Appendix B attached hereto, since this command 
profile contains only a pulse train and no tail, its analytic 
integral can be evaluated and expressed more expeditiously. 
3.4.4 The Actuator Limit Constraint 
45 As mentioned previously, for the case of a time-optimal 
command profile that contains no tail, the actuator limits are 
enforced by properly selecting the pulse train amplitudes to 
meet, but not exceed, the given actuator limits. Since time- 
optimal commands for systems with only poles contain only 
50 a pulse train, no additional equations are required to enforce 
the actuator limit constraint. 

3.5 A Note on Nonminimum -Phase Zeros 

For systems with zeros, the procedure outlined above 
produces a command with a tail made up of components at 
55 the locations of the system zeros. When these zeros are 
nonminimum phase, the resulting tail of the optimal com- 
mand will be unstable by nature, as shown in FIG. 20. As a 
result, at some finite time, the optimal command designed 
for a system with nonminimum-phase zeros will exceed the 
60 prescribed actuator limits. By the original problem statement 
for the time-optimal control problem, solutions for com- 
mand profiles that exceed the actuator limits are not allowed. 
Consequently, it can be argued that the tail of any time- 
optimal command cannot contain any components from the 
65 system nonminimum-phase zeros. 

Given this rationale, the question then becomes whether 
the dynamics of system nonminimum phase zeros can be 
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leveraged in any other way to reduce the system response 
time. It is known from the dynamics cancellation constraint 
that incorporating any uncancelled dynamics into the com- 
mand profile will either increase the time-length of the 
command or cause unwanted system residual vibration. 5 
Consequently, it can be argued that, outside of direct pole- 
zero cancellation, there are no additional dynamic properties 
that can be added to the command profile to compensate for 
the nonminimum-phase zeros. The time-optimal command, 
therefore, for a system with nonminimum-phase zeros is 
identical to the time-optimal command for the equivalent 1 
system with identical steady-state gain and the 


40 

required about three system features. First a linear system 
model is required to identify the system poles and zeros. 
Second, the actuator limits must be specified, and, last, the 
desired system output response must be known. From this 
information, a time-optimal command can be created by 
enumerating the constraint equations and employing an 
optimization routine to search the solution space. Since 
these equations are algebraic, solutions can be found rapidly 
and reliably using a computer. Additionally, by using the 
simple matrix notation suggested in this chapter, implemen- 
tation can be equally streamlined. 


TABLE 3.5 


Summary of the governing equations for the time-optimal control 
of systems with both poles and zeros. 


Equation 
describing the 
command 
profile. 

n r 

u(t) = Yj a l fit - tj) + Ya C j cZi(t_tn) fit - tn) 

j=0 j=l 


Dynamics 

Cancellation 

Constraints 


l =0 

s= Pi 

Boundary 

Condition 

Constraints 



Actuator Limit 
Constraint 

^mm — u tail(t) — u max 



nonminimum-phase zeros removed. For example, consider a 
system with a transfer function that contains a nonminimum- 
phase zero, z 1 : 

Cs-S 1 )Cs + « 2 ) (3.47) 

O'! — , 

s(s + Pi)(s 4- p 2 ) 

where the values of z l9 z 2 , p 1? and p 2 are all positive. Now, 
by removing the nonminimum-phase zeros from this transfer 
function while preserving its DC gain, a new transfer 
function can be created: 

-zi(s + z 2 ) (3.48) 

Cj2(£J = . 

s(s + pO(s + p 2 ) 

Following the rationale outlined in this section, the time- 
optimal command for this modified system is substantially 
identical to the time optimal command for the system in 
equation 3.47. Therefore, as a general practice, for systems 
with nonminimum-phase zeros, time-optimal commands 
can be derived effectively simply by ignoring any 
nonminimum-phase numerator dynamics. 

3.6 Summary 

This section has outlined an approach for deriving time- 
optimal commands for linear systems. As part of this 
approach, a set of governing equations has been presented 
for defining the structure of the optimal command profile 
and specifying the problem constraints. These equations are 
summarized in Table 3.5 and Table 3.6 for the general 
solution case and the specific case of systems with only 
poles. In order to implement these equations, knowledge is 


TABLE 3.6 


Summary of the governing equations for the time-optimal 
control of systems with iust poles. 

Equation 
describing the 
command 
profile. 

u(t) = ^ajl(t- 
j=o 

tj) 

Dynamics 

Cancellation 

Constraints 

z^r 1 ^ 

j=° 

= 0 

S=Pi 

Boundary 

Condition 

Constraints 

to = 0 

dy = lim(^)- 
s^o\D(s)/ 

ITHL 

Actuator Limit 
Constraint 

none required 



4 Examples of Time-Optimal Commands for Simple Sys- 
tems 

Section 3 above outlined the general procedure and nec- 
essary equations to derive time-optimal commands for any 
SISO linear system in accordance with the present inven- 
tion. In order to illuminate how this approach can be applied 
60 to real systems, several simple examples will be considered 
here. This section begins with a look at three very simple 
systems with only denominator dynamics. For each of these 
three systems, the constraint equations will be used to derive 
analytical solutions for the time-optimal command profiles. 
65 Although these solutions are very simple and straightfor- 
ward to derive, this will clarify the details of the solution 
approach provided by the invention and highlight key fea- 
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tures of time-optimal command profiles for linear systems. 
After this look at commands for systems with only poles, an 
analytic solution will be provided for a system with two 
poles and one zero. This solution will illustrate the form of 
the constraint equations as well as the resulting command 
profiles for systems with both poles and zeros. Since analytic 
solutions for time-optimal commands are generally avail- 
able only for simple systems, section 4.5 of this section 
looks at command profiles for a more complicated spring- 
mass system derived using numerical optimization. 

4.1 A System with One Rigid-Body Pole 

FIG. 21 a shows a mechanical system having a single 
rigid-body pole as shown in FIG. 21Z?. This system has the 
transfer function 


In this problem, it is desired to transition the mass from its 
initial velocity to a specified final velocity as quickly as 
possible using a bounded force input. Although this is a 
simple problem, a formal approach will be taken to illustrate 
the procedure for deriving time-optimal commands. 

Step 1: Select a Candidate Command Profile 
As discussed in section 2.3.1 above, the Bang — Bang 
Principle dictates that the time-optimal command profile 
must always saturate the system actuators. Furthermore, for 
this system, it can be seen that a single actuator pulse of 
finite duration can be used to transition the mass to the 
desired final velocity. Based on this understanding, the 
time-optimal command profile can be constructed, as shown 
FIG. 21c. Using the command profile equation outlined in 
Table 3.6, the parametric equation describing the time- 
optimal command profile for this system can be written as 

m=F ma Xt-t 0 )-F min l{t-t 1 ) (4.2) 

Step 2: Impose the Problem Constraints 
As equation 4.2 illustrates, the magnitude of the time- 
optimal command is completely specified by the given 
actuator limits. The remaining unknowns, therefore, are the 
switch times. In order to find values for these unknowns, the 
problem constraints must be met. Since the actuator limits 
are already met by the chosen candidate command profile, 
only the dynamics cancellation constraint and the boundary 
conditions must be imposed. 

To satisfy the dynamics cancellation requirement, the 
equation in Table 3.6 can be invoked to yield the following 
expression: 

(F max e- St0 -F max e- Stl )\ s=0 = 0. (4.3) 

This equation easily reduces to 

F max -F max =0. (4.4) 

This equation is a statement of the fact that the final value 
of the time-optimal command for this system must be zero. 
Since the amplitudes of the time-optimal command were 
already selected to meet this condition, the result is trivial. 

In addition to the dynamics cancellation constraint, the 
two boundary condition constraints must also be imposed: 
the first one sets the initial time of the command, and the 
second ensures that the command delivers the system to the 
desired final velocity. As in Table 3.6, these constraints can 
be stated as follows: 


and 

l n i l 

dv = —■ F(t)dt = - ■ - to), 

m J m 


where dv is the desired change in velocity of the system 
response. 

Step 3: Solve Analytically 

By combining equations 4.5 and 4.6 the following result 
can be reached for the value of the final command switch 
time, t ± : 


15 


mv d 



(4.7) 


With this equation, the time-optimal command is completely 
specified for the system with one rigid-body pole. FIG. 22 
20 illustrates the time-optimal command 30 and response 31 for 
this system, where m=l kg, the desired change in velocity is 
0.5 m/s, and the actuator limits are ±1 N. 

4.2 A System with One Real Pole 

FIG. 23 a shows a system with one real pole, as illustrated 
25 in FIG. 23 b, and can be described by the transfer function 


30 

In this system, it is desired to change the velocity of the mass 
by a specified amount as quickly as possible. The identical 
procedure that was used in the first example will also be used 
for this system to derive the time-optimal command. 

Step 1: Select a Candidate Command Profile 
The first step in creating the candidate command profile is 
to specify the amplitude and the number of switches. For the 
system in FIG. 23 a, it can be reasoned that the time-optimal 
command requires two switches, one to turn the actuator 
4Q full-on while the mass is accelerating, and one to set the 
actuators to the level required to maintain the desired final 
velocity. Such a command profile is illustrated FIG. 23c, and 
has the equation 

m=F ma A{t-t 0 )+{F ss -F m ^)l{t-t 1 \ (4.9) 

45 

where F ss is the final steady -state command level required to 
effect the desired change, dv, in the system output. 

Step 2: Impose the Problem Constraints 
As in the rigid-body case, the switch times of the optimal 
50 command can now be found from (1) the dynamics cancel- 
lation constraint and (2) the boundary condition constraint. 
In the first instance, given that the system pole is located at 
s=-b/m, the equation in Table 3.6 yields 

55 (F m ^- s *+(Fss-F m Je-"%__ b/m =0. (4.10) 

Evaluating this expression at the value of the system pole 
produces the constraint equation: 


60 


F mw ,e™° + ( F ss - F mja ,)e™ h = 0 . 


(4.11) 


Second, from the boundary conditions specified in the 
problem, two additional constraint equations can be formu- 
65 lated: 


6i— 0, 




= 0 , 


(4.5) 


(4.12) 



and 
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dv = l 



(4.13) 


Note that, since the given system has no rigid-body poles, 
the input command does not need to be integrated to impose 
the second boundary condition. 

Step 3: Solve Analytically 

Therefore, with equations (4.11) through (4.13), the time- 
optimal sequence is completely specified; equation (4.13) 
can be used to find the value for F ss , and equations (4.11) and 
(4.12) can be combined to solve for t 2 : 

m ( 1 ) (4.14) 

f2 = iT-t/w/w)! 


FIG. 24 illustrates response 34 of a system with one real pole 
to step command 32, and FIG. 25 illustrates the response 36 
of such a system to time-optimal command 35. For the 
system used in these plots, m=l kg, b=l kg/s, the desired 
change in velocity is 0.5 m/s, and the actuator limits are ±1 
N. As expected, with the time-optimal command, the settling 
time of the system response is reduced to about 0.7 seconds 
from about 4 seconds for the step response. 

4.3 A System with a Pair of Complex Poles 
As a third illustration of the procedure for deriving 
time-optimal commands, the system in FIG. 2 6a, which has 
the transfer function 

1 (4.15) 

G{s) = - , 

ms 2 +bs + k 


will be considered. The plot for this transfer function is 
shown in FIG. 2 6b. In this system, it is desired to change the 
position of the mass and bring it to rest as quickly as possible 
using an input force command. 

Step 1: Select a Candidate Command Profile 
Following the same procedure as in the two previous 
cases, the candidate time-optimal force profile shown in 
FIG. 26c can be represented by the equation 

,F(0=^^1 (4.16) 

where F ss is the final steady state force required to effect the 
desired change in position, dx. 

Step 2: Impose the Problem Constraints 
In order to find the values of the switch times in this 
command profile, the dynamics cancellation requirement 
and boundary conditions can be used to form the necessary 
constraint equations. First, the locations of the system poles 
can be specified as 




and 


s 2 =-C,u n -uJ, (4.17) 

where £, is the damping ratio, co n is the natural frequency, and 
w d is the damped natural frequency of the given second- 
order system: 



and oj d = w„Vl -£ 2 . 


5 

Now, from the dynamics cancellation constraint equation, 
we know that, for the two system poles 

{F max e- st °+{F min -F max )e-^ 

10 and 

(4.18) 

By substituting the given value of s at each of the pole 
5 locations into these equations, it can be found that both 
equations yield the same result. However, by constraining 
the real and imaginary parts of the resulting expressions to 
equal zero, two equations can be formed: 


F max cos(GVo)+ . . . {F m in -F m ax )e QjMn cos((x) d t 1 )+ . . . (F ss - 
20 F mi , l )e^ uW2 cos(n^ 2 )=0, (4-19) 

and 

~F max e^ nt ° sin(c»V 0 )- . . . (F min -F max )e^ ntl sin(o vj- . . . (F ss - 
Tm> W2 sin(c»V 2 )=0. (4.20) 

25 

These two equations are the final form of the dynamics 
cancellation constraint for a system with a pair of complex 
poles. 

From the boundary condition equations in Table 3.6, two 
30 additional constraints can be formed: 

r 0 =o, (4.21) 

and 


35 


1 

dx = - ■ F{t ) 



(4.22) 


where dx is the desired change in position of the mass. 

Step 3: Solve Analytically 

40 Given equations (4.19) through (4.22), the time-optimal 
command profile is completely specified, and values for the 
optimal switch times, T and t 2 , can be found by solving the 
constraint equations. In general, these constraint equations 
must be solved numerically using an approach such as the 
45 one described in section 6 below. However, for the zero- 
damping case, an analytic solution is available: 



1 | 

ti = — acos 
lO n \ 

f - Fss) + 0.5 Fl - 'j 

(4.23) 

50 

[ Tnax(Tnin “ Tnax) ) 



1 1 

t 2 = — acos 
iO n 1 

(F mi AF mS s-F S s) + 0.5Fl\ 

{ Tnax(Tnin “ F ss ) J 

(4.24) 


55 FIG. 27 illustrates a response 39 for a system with a pair 
of complex poles to step command 37, and FIG. 28 illus- 
trates a response 41 for such a system to time-optimal 
command 40. For these plots, k=l N/n, the natural frequency 
of the system is 2jt rad/sec, the damping ratio is 0.1, the 
60 desired change in position is 0.5 m, and the actuator limits 
are ±1 N. From these results, it can be seen that the settling 
time of the system response can be reduced from about 6 
seconds for the step response, to about 0.2 seconds for the 
time-optimal response. 

65 4.4 A System with One Zero and Two Rigid-Body Poles 
As the fourth example for deriving time-optimal 
commands, a system with one zero and two rigid-body poles 



US 6,694,196 B2 


45 

will be considered. One possible physical representation of 
this system is a single mass with an input force profile with 
a derivative feedforward term, as shown in FIG. 29 a. From 
this block diagram, the following transfer function can be 
derived: 


46 

Now, with the dynamics cancellation constraints formulated, 
the boundary conditions can be imposed. The first boundary 
condition, as before, is trivial: 

5 f o =0. (4.29) 


G(s) = 


X(s) 

U(s) 


s + K 
ms 2 


(4.25) 


the plot for which is shown in FIG. 29 b. In this system, it is 
desired to derive the input command profile, u(t), that will 
change the position of the mass by a desired amount, dx, and 
bring it to rest as quickly as possible. Unlike the three 
previous examples, this system will illustrate how solutions 
can be derived for systems with numerator dynamics as well 
as repeated roots. Also, in order to simplify the derivation 
calculations, actual values for some of the system param- 
eters will be substituted into the constraint equations. The 
values are as follows: u max =l, u min =-l, K=2, m=l, and 
dx=l. 

Step 1: Select a Candidate Command Profile 
As shown in FIG. 29c, the candidate time-optimal com- 
mand profile for a system with two poles and two zeros will 
have a pulse train followed by a tail. Following the guide- 
lines outlined in section 2.3.3, we can assume that the pulse 
train will have three switches, including the first and last. 
Furthermore, the tail of the command will have the same 
time constant as the system zero, at s=-K, and an initial 
amplitude of c 1 . Given this command construction and the 
specified actuator limits, u max and u min , an equation for the 
time-optimal profile, u(t), can be written as follows: 

u(t)=u max l(t-t^)+(u min -u max )l(t-t 1 )- . . . u min l(t-t 2 )+c 1 e~ K ^~ 
r 2) l(*-* 2 ). (4.26) 

In this equation, the only unknowns are the switch times, t 0 , 
t-L, and t 2 , and the initial amplitude of the command tail, c 1 . 
By forming and solving the constraint equations, and ana- 
lytic result for these values can be reached. 

Step 2: Impose the Problem Constraints 
Since this system has both poles and zeros, the complete 
form of the time-optimal constraint equations, as summa- 
rized in Table 3.5, must be employed. For the dynamics 
cancellation constraint, since this system has two repeated 
rigid-body poles, the dynamics cancellation equation must 
be enforced twice at s=0, once with the pole multiplicity 
value, q,-, equal to one and again with q,- equal to two. 
Performing the substitution for the first pole with q~l yields 
the following result: 

[ _ _ (4.27) 

w ma x® 0 4- (w m in — W max )f? * — 

"imn^ 2 + €~ St2 (ci - \ ]| =0 


The second boundary condition, as stated in Table 3.5, is a 
bit more complicated since it requires evaluating the double 
integral of the optimal command profile: 

dx= £(ff u(r)dr ) L- (430) 


15 where dx is the desired change in the position of the mass in 
the system. In order to find an analytic solution for the 
time-optimal command, the integral in this equation must be 
evaluated analytically for the given expression for u(t) in 
equation 4.26. This can be done by following a strategy 
20 similar to the one outlined in Appendix B attached hereto. 
Alternately, as discussed in section 3.2.2, this boundary 
condition can be enforced by evaluating the following 
general expression using L’ Hospital’s Rule: 


25 


dx = lim 

s-^0 


G(s)\ 


Y aj e*j +e-*>Y 

n u s ~ Zj 


(4.31) 


30 
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For the system at hand, this expression reduces to 


s + K 

dx = lim — . . . 

s->o ms 1 

« ma x«" ir ° + («min - W max )e“ Sfl - 

“■”" <r “ 2 +c_s ' 2ci JTjfl 


(4.32) 


which can be further simplified to 
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(S + K\ 
dx = lim 

s-h>o \ m f 


lim I 4r I u maK e st o + ( Mmin - w max )« - 



(4.33) 


Now, the first limit in this expression is easy to evaluate. The 
50 second limit, however, must be evaluated using L’Hospital’s 
Rule since it is indeterminate of the form (0/0). In order 
simplify the notation in this derivation, values for system 
parameters will be substituted into this expression. 
Specifically, using the values: u mfl ^=l, u min =-l, and, from 
55 the first boundary condition, t o =0, equation 4.33 can be 
rewritten as 


Similarly, for the second pole, q~2, the resulting constraint dx = lim(^-^) -Um^l -2e + \e st 2 +e 

equation is: 


60 


«max*0« St ° +(«min “Wmmkie ^ + 

ciK d K 


l 1 2 s + K 2 (s + 


(s + K) 2 )i\ s=0 


(4.28) Evaluating the first limit in this equation results in 

dx = — ■ limi — (l - 2e~ stl + Le~ st2 + e~ si2 ci — - — ). 
m s->oLs 2 v s + K/ 


65 


(4.35) 
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Now, from L’Hospital’s Rule, it can be stated that, if G 1 (s) 
and G 2 (s) are zero at s=0, then 


gifr) = G[(s) 

s-> 0 G 2 (.S') G '2 (5) 


In order to apply this formula, we must first make the 
following statements: 


GiO) = 1 - 2e + le s ' 2 + e s * 2 ci , and 

s + K 


date command profile was already selected to meet this 
condition, equation 4.42 is automatically satisfied. From the 
second dynamics cancellation constraint, however, we can 
form an expression for t 1 : 


h ci 

h = 2 " 4 - 


Now, from the boundary conditions constraint, equation 
4.39, substituting the same system parameter values as well 
as m=l and dx=l, produces the result 


Now, with these definitions, applying L’ Hospital’s Rule is 
straightforward. Note that, since the expression for G 2 (s) 
contains an s 2 term, L’ Hospital’s Rule must be applied twice 
to reach a determinate result. Performing this task, namely 
taking the second derivative of the expressions for G a (s) and 
G 2 (s) and substituting the value s=0, yields the following 
result: 


, ^ t2 J2 2t 2 C ! ) 


1 = -2/f + *2 - y - t 2 ci . 


(4.38) 15 


From this equation, we can then substitute the expression for 
t-L in equation 4.44 and simplify to yield 


4 " c l r 2 - [ + C 1 + 2^ = t 


Solving this equation for t 2 results in 


ci V2" 
h= 2 ± ~ y 


This is the final form of the second boundary condition 
constraint for the system with one real zero and two rigid- 
body poles. 

Given the dynamics cancellation constraint equations, 
4.27 and 4.28, and the boundary condition constraint 
equations, 4.29 and 4.39, the only equation that needs to be 
formed is the actuator limits constraint. As in Table 3.5, this 
expression can be stated as 


Now, as illustrated in FIG. 29c, given that the maximum 
value of the command tail is defined to be c 1? this equation 4Q 
reduces to 


In order to minimize the length of the time-optimal 
command, we need to find the smallest value of t 2 that 
satisfies equation 4.47. Also, from the actuator limits 
constraint, equation 4.41, we must have a value of c 4 such 
that 


By plotting the possible values of t 2 over this range of values 
for c 1? it can be found that t 2 is a minimum when c-^-1. 
From this result, this optimal value of c 1 can be substituted 
into equation 4.47 to produce 


1 V2~ r- 

t 2 = -- ± — - V3 = 0.725, and - 1.725 seconds. 


With this expression, the constraint equations for the time- 
optimal command are complete. 

Step 3: Solve Analytically 

In order to minimize the notational complexity of the 
solution approach, we will first substitute values for the 
system parameters into the constraint equations. 
Specifically, for the dynamics cancellation constraints in 
equations 4.27 and 4.28, substituting the known values 
u majc = 1 , u min =-l, K=2, and, from equation 4.29, t o =0, and 
evaluating at s=0 yields 


( 2 ci) 

t‘--] =c 


2h - 1 2 + — = 0 . 


From this result, it can be seen that the first constraint is 
always zero. As was the case for the example in section 4.1, 
the dynamics cancellation constraint for the first rigid-body 
pole in a system states simply that the sum of the pulse train 
amplitudes must be zero. Since the amplitude of the candi- 


Now, since t 2 must be greater than zero, it can be concluded 
that the optimal value for t 2 is 0.725 seconds. Also, by using 
45 these values in equation 4.44, the optimal value for t 2 can be 
found to be 0.613 seconds. 

FIG. 30 illustrates the time-optimal command profile 42 
resulting from this derivation and the corresponding system 
response 44. For comparison purposes, FIG. 31 illustrates 
50 the response 45 of the same system to a pulse command 46 
designed to produce the same gross motion in the system 
output. This pulse command was created using only knowl- 
edge about the system rigid-body behavior. As the figure 
illustrates, when the zero dynamics are taken into consid- 
55 eration to design the command profile, the system response 
time can be cut in half. 

4.5 A Simple Spring-Mass System 

The four examples presented above all illustrated the 
procedure and the form of the governing equations for 
60 deriving time-optimal commands. These examples were 
selected since they were simple enough to allow for analytic 
solutions that revealed important features about the nature of 
time-optimal commands. In general, analytic solutions are 
only available for very simple systems. For most systems, a 
65 numerical optimization approach must be employed to solve 
the time-optimal constraint equations. This section looks at 
a more complicated system and how time-optimal com- 
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mands can be derived using this optimization approach. 
Specifically, the system shown in FIG. 32a will be consid- 
ered. This system consists of two masses with one flexible 
mode, one real mode and one rigid-body mode, and the 
transfer function from the specified force input to the 
position output also has a pair of complex zeros. This system 
might be a good descriptor of any vehicle or automated 
machine with a flexible appendage. The transfer function, 
G(s), for this system can be written as 

X (5) mis 1 + b2S + k (4.48) 

F(s) s(mim 2 S 3 + ( m 1^2 + ni 2 bi + m 2 b 2 )s 2 + 

(mi k + tri2k + bi ^2)5 + kbi ) 


For the purposes of this example, the following values will 
be used for the system parameters: m 1 =l kg, m 2 =2 kg, b 1 =l 
N/(m/s), b 2 =0.8 N/(m/s), and k=2 N/m. Furthermore, for the 
problem specifications, it will be assumed that the actuator 
limits are F mflJC -l N and F min =-1 N and that the desired 
output motion of m 1 is 0.5 m. Substituting these values into 
the system transfer function yields the result: 

X(s) _ 2s 1 + O.85 + 2 (4.49) 

G{ - S) = Ttf) = s(2s 3 + 4.4s 2 + 6.Ss + 2)' 




r f 1 

a v 


Lnin — Lnax 

a 2 

= 

Lnax — Lnin 

a 3 


Lnin ~ Lnax 

#4 


— F min 


(4.51) 


where for the given values of the actuator limits, namely 1 
10 and -IN, this vector assumes the form: 


15 



(4.52) 


Notice that, since the spring-mass system has a rigid body 
20 mode, the command profile must have a steady-state value 
of zero in order to produce point-to-point motion in the 
system output. By specifying the pulse train amplitudes in a 
to sum to zero, this factor is automatically taken into 
account. For the system zeros in equation 4.50, a similar 
25 vector expression can be formed: 


The pole -zero plot for this system is shown in FIG. 32 b, and 
the values of the system poles and zeros are summarized in 
Table 4.1. Using this system information, a time-optimal 
command will now be derived. 


TABLE 4.1 


Summary of the dynamics 

in the simple spring-mass system. 

rigid-body pole: 

s = 0 

real pole: 

s = -0.37 

time constant, t c = 2.73 sec. 

complex poles: 

s = -0.92 ± 1.37i 
frequency = 0.26 Hz 
damping ratio = 0.56 

complex zeros: 

s = -0.20 ± 0.98i 
frequency = 0.16 Hz 
damping ratio = 0.20 


z=[ziz 2 l (4.53) 

and, given the values from Table 4.1, this vector becomes 

z=[-0.20+0.98i-0.20-0.98i]. (4.54) 

Now, with the values for the pulse-train amplitudes and 

system zeros completely defined by equations 4.52 and 4.54, 
the only unknowns that remain in the command profile are 
the switch times, 

(4.55) 

and the tail coefficients, 

_ r Cl (4.56) 

[C2 ' 


30 


35 


40 


Step 1: Select a Candidate Command Profile 
As shown in FIG. 32c, the candidate time-optimal com- 
mand profile for the simple spring-mass system will have a 
pulse train followed by a tail. Since this system has four 
poles and two zeros, the minimum number of switches that 
must be in the pulse train is three, including the first and last, 
as discussed in section 2.3.3. However, as a good initial 
guess for the number of switches that will be required in the 
actual time-optimal command for the given system, a good 
rule of thumb is to select one more switch than the number 
of system poles. Since the specified system has four poles, 
the candidate time-optimal command in FIG. 32c has a pulse 
train with five switches. The general equation for a time- 
optimal command profile for a system with poles and zeros 
is listed in Table 3.5. For the case where the command has 
five switches, n=4, and two zeros, r=2, this expression can 
be rewritten as 

4 2 (4.50) 

F(t) = £ ajKt-tj) + Yj 
j= 0 j= 1 


From the given system actuator limits, the pulse train 
amplitudes in this equation can be specified as follows: 


45 In the case of the tail coefficients, since the system contains 
a pair of complex zeros, the tail will have a damped 
sinusoidal response. Consequently the coefficients can be 
expressed as 


50 



(4.57) 


55 where a is the initial amplitude of the command tail, as 
shown in FIG. 32c, and (|) is its phase. With this expression, 
it can be seen that the only unknown variables in equation 
4.50 that are required to describe the time-optimal command 
profile are the switch times, t, and the tail parameters, a and 
60 <|>- 

Step 2: Impose the Problem Constraints 
Given that the only unknown parameters of the-time- 
optimal command are the switch times, t, and the variables 
that make up the tail coefficients, c, the problem constraints 
65 can be formed to guide the search for optimal solutions of 
these values. The first constraint that needs to be imposed is 
the dynamics cancellation constraint. As derived in section 
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3.2.1. 1, these equations can be expressed in convenient 
matrix notation for systems without repeated roots as 

exp(-st)a+M.*exp(- st„)=0, (4.58) 

where 

M=(l./(l-(l./s)z))c. (4.59) 

The vector definitions for a, z, t, and c are given in equations 
4.52, 4.54, 4.55, and 4.57, respectively, and, from the values 
of the system poles in Table 4.1, the vector s can be defined 
as 



Pi ' 


0 

s = 

Pi 

= 

-0.37 


.P3 . 


-0.92 + 1.37i 


As discussed previously, since the dynamics cancellation 
equations for each pole in a complex pair are identical, only 
one of the complex poles needs to be included in the vector 
s. 

In order to impose the boundary condition constraint for 
this problem, the two equations from Table 3.5 can be 
applied: 


t= 0 


(4.61) 

s->o\D(s)l \ 

S mdr )L- 

(4.62) 


In the second equation, given the desired system output 
motion, dx, of 0.5 m, and that the limit of the system transfer 
function without the rigid-body is unity, the final equation 
for the boundary condition constraint becomes: 

0.5=l-(J J F(0^)U- (4.63) 

For the third and final constraint that needs to be enforced 
for the time-optimal control problem, the actuator limit 
constraint can be written as 

F min ^F taii mF max , (4.64) 

where F ffll7 (t) is the time-response of the command tail. From 
the expression for the time-optimal command profile in 
equation 4.50, an expression for this tail can be written as 

^ i 7(0=(c ie zl(W4) +c 2e z2( '^ ) )l(r-r 4 ). (4.65) 

This expression can be calculated during the solution of the 
constraint equations to make sure the actuator limits are 
never exceeded. 

Step, 3: Solve and Verify 

The final step in deriving the time-optimal command 
profile for the simple spring-mass system is to solve the 
constraint equations and verify the result. Since the con- 
straint equations for this system are too complex to be solved 
analytically, a numerical optimization routine must be used. 
A routine, such as the one described in chapter 6, will take 
the vector of values for the system poles, s, and zeros, z, as 
well as the pulse-train amplitudes, a, and search for the 
shortest possible set of switch times, t, and tail coefficients, 
c, that satisfy the constraint equations. In order to evaluate 
the constraints for this problem, equations 4.58, 4.59, 4.61, 
4.63, 4.64, and 4.65 must be used. Specifically, equations 
4.58 and 4.59 are the matrix equations for the dynamics 
cancellation requirement. Upon evaluation, these equations 
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will yield a set of four constraints, one for both the rigid- 
body and real system pole, and one for the both the real and 
imaginary part of the equation for the complex pole. Equa- 
tions 4.61 and 4.63 are the problem boundary conditions. 
5 The first is trivial to impose and the second requires the 
evaluation of the integral of the command profile. This 
integral can be performed most efficiently using the analytic 
solution presented in Appendix B. Last, equations 4.64 and 
4.65 are the actuator limit constraints. During the solution 
10 process, these equations must be used to calculate the profile 
of the command tail and ensure that it does not exceed the 
specified actuator limits. 

Using a standard optimization process, such as GAMS 
[219] or the ones found in the Matlab Optimization Toolbox 
15 [218], solutions can be found for the time-optimal command 
profile that satisfies the problem constraints. Typically, these 
processes rely on an initial guess for the command switch 
times, t, and tail coefficients, c, and then proceed to search 
through the solution space of the constraint equations until 
20 a time-optimal solution is found. In general, as discussed in 
greater detail in section 6, initial guesses are easy to make 
based on intuition or the system dynamics. Also, since all of 
the constraint equations in this problem can be expressed 
algebraically, little computation is required to perform this 
25 optimization. Although solution times typically depend on 
the quality of the initial guess and the available computing 
resources, solution times for systems of moderate complex- 
ity are on the order of seconds. For the spring-mass system 
in this example, a time-optimal command profile was found 
30 in less than three seconds using a 150 MHz desktop work- 
station. 

As a second step in the process of solving for time- 
optimal commands, a verification scheme is highly valuable. 
In particular, since optimization processes can often return 
35 local minima rather than the time-optimal global minimum, 
a verification scheme can prove useful if it can identify 
time-optimal solutions. As discussed in greater detail in 
section 6, by using the conditions of Pontryagin’s Minimum 
Principle, a straightforward verification process can be con- 
40 structed to guarantee that the commands delivered by the 
optimization process are indeed optimal. 

FIG. 33 illustrates the time -optimal command solution 48 
and system response 47 that results from a numerical 
optimization of the constraint equations in this example. As 
45 this solution indicates, the resulting time-optimal force 
command delivers the system from its initial position to its 
final position in under two seconds. Notice that the pulse 
train in this command has only three switches. Even though 
the original candidate command profile contained five 
50 switches, the optimization routine successfully reduced the 
number of switches by two to the optimal level. 

FIGS. 34a to 34 d compare the time-optimal command 
and response for the spring-mass system to the performance 
of three other command profiles. The first plot in FIG. 34a 
55 illustrates the system response 49 to a simple pulse com- 
mand 50 designed to meet the same actuator limits and 
produce the same amount of displacement in the system 
output. As this plot indicates, due to the real and complex 
system denominator dynamics, the system reaches its final 
60 value in response to the pulse after about nine seconds. The 
second plot in FIG. 34 b depicts the system response 51 to a 
time-optimal negative input shaper 52. As discussed in 
section 2.4.4, time-optimal commands can be created using 
the input shaping constraint equations. The resulting com- 
65 mand profiles are designed to produce point-to-point motion 
in the system output without exciting unwanted vibration in 
the system flexible modes. Since the flexibility in this system 
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does not dominate the overall dynamic response, the 
response of the system to the time-optimal input shaper 
shows no improvement over the pulse command. In the third 
plot in FIG. 34c, a time-optimal input command 54 was 
designed for the equivalent spring-mass system with all of 
the numerator dynamics removed. Consequently, the result- 
ing command profile consists of a pulse train without a tail. 
When applied to the spring-mass system in this example, 
this command delivers the system response 55 to its final 
value in slightly under four seconds. Comparing this 
response 55 to the response 56 to the full time -optimal 
command 57 in FIG. 34d, it can be seen that, by designing 
the time-optimal command profile using both the system 
numerator and denominator dynamics, the time of system 
response can be dramatically reduced. For the current 
example, this reduction is by about a factor of two; the 
amount of reduction that would be seen in other systems 
depends on the amount of contribution the numerator 
dynamics make to the overall system response. 

5 Creating Time-Efficient Commands with Additional Con- 
straints 

In the preceding sections, an approach for deriving time- 
optimal commands for any type of linear system was pre- 
sented. This approach provides a straightforward and effec- 
tive procedure for identifying the bounded command profile 
that will produce the fastest possible response in a given 
system. In many time-critical applications, the optimal com- 
mands that result from this methodology can be highly 
valuable for maximizing system performance. However, in 
other systems that do not require such rapid response, 
time-optimal command profiles may be undesirable. For 
example, in systems with a large degree of dynamic 
uncertainty, time-optimal commands may excite unwanted 
residual vibration due to discrepancies between the system 
model and actual behavior. Additionally, because of their 35 
bang — bang nature, time-optimal commands may result in 
excessive fuel usage or heavy operating loads in certain 
classes of systems. In order to address these issues, new 
constraints can be incorporated into the solution methodol- 
ogy to derive commands with more practical properties. 
These commands, although not strictly time-optimal, can 
deliver time-efficient system behavior while accommodating 
other important system performance metrics. 

The purpose of this section is to show how the solution 
framework developed in section 3 can be expanded to 
include more practical system constraints. In order to 
accomplish this, two extensions to the basic solution method 
will be considered: first, strategies will be presented for 
deriving time -efficient commands that are robust to uncer- 
tainty in the system model, and second, methods will be 
considered for limiting the length of the tail on optimal 
command profiles. Following these two specific cases, sug- 
gestions will be made for incorporating additional problem 
constraints into the general solution framework. This dis- 
cussion will illustrate that the solution methodology pre- 
sented herein is not only effective at deriving time -optimal 
command profiles but can also be extended easily to derive 
other types of more practical time -efficient commands. 

5.1 Designing Commands with Enhanced Robustness to 
System Uncertainty 

When modeling a physical system, designers attempt to 
create a mathematical representation that captures all impor- 
tant aspects of system operation. Unfortunately, due to such 
factors as time-varying dynamics and nonlinear behavior, 
discrepancies always exist between the model and the actual 65 
system. As a result of these discrepancies, time-optimal 
commands designed using model parameters can sometimes 
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result in unacceptable performance upon implementation. In 
order to address this issue, a strategy can be formulated for 
deriving an input command that is robust to uncertainties in 
system dynamics. This strategy relies on the same solution 
5 framework outlined in previous chapters but incorporates 
additional problem constraints to enhance command robust- 
ness. Before this strategy can be presented, however, we 
must first be clear about the definition of robustness. 

A time -optimal command that is not robust to uncertain 
10 system dynamics will often deliver unacceptable perfor- 
mance when the system behaves differently than the model 
predicts. Typically, this performance degradation is mea- 
sured in terms of the residual response of the system output. 
As illustrated in FIG. 35, residual response is a measure of 
15 the difference between the ideal system response and the 
actual behavior. In the ideal case, a time-optimal command 
will transition a system from its initial state to its exact final 
state and keep it there. However, when faced with model 
discrepancies, this time-optimal command will always result 
20 in a nonzero amount of residual response around the desired 
system output value. 

In order to characterize the influence of modeling uncer- 
tainties on unwanted system residual response, consider 
FIG. 36. As this figure suggests, a linear model can be 
25 represented as a collection of poles and zeros in the Laplace 
domain. When a system displays behavior somewhat differ- 
ent than the model, this can be manifested in one way as a 
difference in the actual locations of the system poles and 
zeros. The larger the distance between the modeled and 
30 actual system poles and zeros, the greater the amount of 
dynamic uncertainty in the system. When a time-optimal 
command that was designed for the system model is applied 
to the actual system, these discrepancies can result in output 
behavior with excessive residual response. 

Given this understanding, one can imagine that a possible 
method for understanding the influence of dynamic uncer- 
tainties on system performance is to vary the locations of the 
system poles and zeros and catalog the resulting amount of 
residual response in the system output. A command that is 
40 robust to dynamic uncertainty will demonstrate little per- 
formance degradation over changes in the system dynamics, 
and a nonrobust command will show sharp changes. Using 
this approach, the locations of each system pole and zero can 
be varied from their nominal values to measure the level of 
45 robustness in the given command to changes in system 
dynamics. Of course, in order to create a complete picture of 
this relationship, the locations of the poles and zeros would 
have to be varied in the two -dimensions of the s-plane. 
Specifically, each pole and zero could be varied in both 
50 frequency and damping to produce a two-dimensional mea- 
sure of the command robustness. Since the system residual 
response typically demonstrates similar behavior with varia- 
tions in both of these directions, changing the system poles 
and zeros in one dimension is usually adequate for charac- 
55 terizing the robustness of the input command. Traditionally, 
command robustness has been measured by varying the 
natural frequency of the system pole or zero. As illustrated 
in FIG. 37, this corresponds to moving system poles and 
zeros along lines radial from the origin of the s-plane and 
60 plotting the resulting amplitude of residual response in the 
system output. Since rigid-body dynamics in a given system 
are relatively easy to characterize, this robustness measure is 
typically performed with only the nonzero system poles and 
zeros. 

FIGS. 38 and 39 depict some typical robustness plots. For 
each of these plots, the system residual response amplitude 
is plotted versus frequency. Given an input command 
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profile, one of these plots can be constructed for every 
nonzero pole and zero in the system assuming all other 
system dynamics are exact. Typically, the residual response 
is measured as the maximum deviation in the system 
residual from the desired value as a percentage of the total 5 
rigid-body motion of the system output. This residual per- 
centage is plotted against the variation in the natural fre- 
quency of system pole or zero around its nominal value. As 
these plots illustrate, at the point where the system pole or 
zero is exactly equal to its modeled value, the residual 
vibration in the system response is zero. In some cases, this 
frequency axis is normalized so the nominal or modeled 
frequency has a value of one. As the two plots in FIGS. 38 
and 39 illustrate, a curve that exhibits a flatter or lower shape 
around the nominal frequency value will have better robust- 
ness to system uncertainty than one with a steeper profile. 15 
Since the curve in each of these plots is a measure of the 
insensitivity that the command profile shows to dynamic 
variation, these diagrams are often called insensitivity plots. 

In order to construct an insensitivity or robustness curve, 
the residual response amplitude of a system must be calcu- 20 
lated for a range of different values for the locations of the 
system poles and zeros. While possible to perform using 
numerical simulation, this approach is computationally 
intensive and time consuming. Abetter approach is to use an 
analytic solution for the residual response of a system to a 2 s 
command profile. Fortunately, as presented in Appendix A, 
a general analytic solution is available for the residual 
system response to a command profile with a pulse train and 
a tail. Although notationally complex, this result allows for 
easy calculation of the residual response amplitude as a 
function of changing system dynamics. 

With a clear definition of robustness and an approach for 
constructing plots to measure it, the remainder of this section 
looks at possible strategies for improving the robustness of 
time-optimal commands to variations in system dynamics. 

In this discussion, enhancing robustness to changes in sys- 35 
tern poles will first be considered followed by a look at 
improving robustness for system zeros. From these insights, 
time -efficient commands with improved robustness will be 
constructed for a simple spring-mass system to demonstrate 
the value of this technique. 40 

5.1.1 Robustness to Variations in System Poles 

As described above, in order to improve the robustness of 
time-optimal commands in the face of uncertainties in the 
system denominator dynamics, the insensitivity curve for 
the command must be flattened around the modeled modes. 45 
This flattening is achieved by reducing the residual vibration 
amplitude in the system response around the frequencies of 
the system response. In Appendix A, a derivation of the 
system response to a time-optimal command profile revealed 
that the residual response contribution of the nonzero poles 50 
could be separated from the overall system response. The 
resulting equation from Appendix A, which describes the 
residual response amplitude due to solely a system pole, p-. 


Ri 

MO = -j* Pl 


j = 0 *= 1 


(5.1) 
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u=l 


Qijk 

(*-!)! 


60 




for all t^t„. The notation in this equation is fully defined in 65 
Appendix A, but for the sake of clarity, a brief description is 
included here: 


R^residue of system pole p,-, 
q^multiplicity of system pole p,-, 
a^spulse train amplitudes, 
tySpulse train switch times, 

Cystail coefficients, 

Q^special residue defined in Appendix A, 
n^number of switches in the command pulse train exclud- 
ing the first, and 
renumber of system zeros. 

From this equation, the robustness curve for a given com- 
mand profile, described by a 7 -, t and c ., can be plotted by 
calculating the maximum y (t) over a range of frequency 
values for p,-. Therefore, in order to improve the robustness 
of the command profile, it is required to reduce the value of 
y (t) over the frequencies near the nominal value of p,-. From 
this equation, it can be seen that, in order to reduce the value 
of y (t) many things can be done. One possible approach for 
improving command robustness is to constrain the pulse- 
train amplitudes, a -, to limit the amplitude of the residual 
response. Similarly, the tail coefficients, c ., might also be 
able to be constrained in some manner to improve command 
robustness to variations in system poles. In general, when 
faced with these many alternatives, we must remember that 
we are looking for a solution that has enhanced robustness 
but is still as close to time-optimal as possible. A traditional 
approach for balancing these tradeoffs is to constrain the 
slope of the robustness curve. Originally applied to increase 
robustness in the input shaping technique [97], this approach 
has been used by many researchers [68, 81, 83, 95, 207]. 
Although not time-optimal by definition, the kinds of com- 
mand profiles resulting from this approach represent a 
special class of solutions that have an excellent combination 
of good robustness and short system response times. These 
commands are often called robust, time-optimal commands. 

In addition to identifying a useful class of robust, time- 
optimal solutions, the approach suggested in the preceding 
paragraph is easy to implement. Specifically, these kinds of 
robust commands can be derived by following the exact 
procedure for deriving time-optimal commands, as outlined 
in section 3, and adding one additional constraint equation 
for each uncertain system pole. This equation must enforce 
the condition that the slope of the robustness or insensitivity 
curve be zero at the location of the nominal system pole. 
This concept can be expressed mathematically for system 
pole, p f , as 


where y (t) can be calculated as in equation 5.1, and p,-* is 
the modeled value of p ( -. As noted in section 2.4.4 and [207], 
enforcing this constraint for a given system pole, p,-, is 
identical to deriving the time-optimal command for an 
equivalent system with an additional pole at s=p,-. In other 
words, for a system that has a single pole at s=p,-, enforcing 
the robustness constraint in equation 5.2 can be achieved 
simply by deriving the time-optimal command for a different 
system that includes a double pole at s=p,-. Given this fact, 
the derivation of robust, time-optimal commands for a given 
system is as easy as deriving the time-optimal command for 
a similar system that contains an additional pole for every 
system mode with a significant degree of uncertainty. 
Furthermore, as discussed in [97], command robustness can 
be increased arbitrarily by taking additional derivatives of 
y (t) with respect to p,. As one might suspect, these addi- 
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tional constraints are identical to the constraints for the 
time-optimal command for a system with multiple poles at 
the location p,-, where one additional pole is added for each 
derivative of y^t). With each additional robustness 
constraint, the resulting command profiles become longer in 5 
length but deliver less residual response in the face of 
uncertainties in the system poles. 

5.1.2 Robustness to Variations in System Zeros 

As discussed in the preceding section, a simple insight 
about the nature of time-optimal commands for systems with 10 
repeated poles led to a straightforward and effective 
approach for improving the robustness of commands for 
systems with uncertain denominator dynamics. 
Unfortunately, these same insights cannot be extended to 
system zeros. In order to explain this point, consider the ^ 
equation from Appendix A that describes the contribution of 
the system zeros to the system residual response: 


y*j(t) = c j(RiQ iM+l) + K)e*j 


for all t^t n , where the notation is the same as described 
above, and 

K^constant resulting from the partial fraction expansion 25 
of G(s), 

z 7 -*=modeled value of system pole z p and 
msthe number of system poles. 

As was the case for the system poles, we can first attempt to 
improve the robustness of the command to variations in 30 
system zeros by taking the derivative of equation 5.3 and 
setting it to zero at the locations of the system zeros. 
Specifically, we must enforce the equation 




where z* is the modeled value of each system zero, z-. Now, 
from equation 5.3 and its derivation in Appendix A, it can be 
seen that the only term in the expression for y^.(t) that 
depends on Zj is R a . Since R, is a residue of the system 
model, it is linearly dependent on z-, and as a result 


— — y z . (r) = constant in z;- 
dz; J 


Therefore, the only way to set this expression to zero at 
Zj=Zj* is to set it completely to zero such as by constraining 
the values of the tail coefficients, c-, to be zero. In this 
circumstance, the resulting optimal command profile would 
contain no tail and have infinite robustness to uncertainties 
in the system zeros. 

As a more gradual approach for improving command 
insensitivity to system zeros, one can reconsider the expres- 
sion for the residual response due to the system zeros in 
equation 5.3. As discussed previously, apart from constrain- 
ing the slope of the insensitivity curve, the robustness of a 
command profile can be enhanced by limiting the amplitude 
of the residual response due to deviations in system zeros 
from their nominal values. From equation 5.3, it can be seen 
that, for a given system with specified values for R,, K, 
and z-*, the only way to reduce the amplitude of y^.(t) is to 
decrease the value of the tail coefficients c y. As discussed in 
more detail in section 5.2, constraints can be imposed easily 
to limit the value of the tail coefficients. The resulting 


command profiles are longer in time length, but have some- 
what better robustness to variations in system zeros as well 
as a shorter tail. 

In terms of the pole-zero cancellation argument, the 
method that was used to design commands to be robust to 
variations in system poles was to design the command for a 
similar system that included additional poles. The result of 
this was a command profile that contained multiple zeros at 
the locations of each uncertain system pole. Carrying this 
analogy to systems with uncertain zeros, one might try to 
place extra poles in the command at the same location of the 
system zeros. As may be obvious, this strategy only intro- 
duces extra dynamics into the system that will increase the 
amount of residual response. Consequently, the only option 
for increasing the robustness of an optimal command to 
variations in system zeros is to limit the amplitude of the tail 
coefficients, c If necessary, these coefficients can be 
reduced all the way to zero to produce a longer command 
with no tail that has infinite robustness to uncertainties in 
system zeros. This approach will be discussed in more detail 
in section 5.2, which presents methods for limiting com- 
mand tail length. 

5.1.3 Examples of Robust, Time-Optimal Commands 

This section presents some examples of robust, time- 
optimal commands that were designed using the approach 
outlined in this section. Specifically, command profiles were 
designed with enhanced robustness to system denominator 
dynamics by applying the exact procedure outlined in sec- 
tion 3 for deriving time -optimal commands to a similar 
system with additional poles. As discussed above, com- 
mands with improved robustness to uncertain system zeros 
can be derived by limiting the command tail length. 
Although not presented here, a discussion of this technique 
and examples of its performance will be given in the 
following section. For all of the results presented here, the 
simple spring-mass system shown in FIG. 32 a will be used. 
The list of dynamics values for that system is repeated in 
Table 5.1 below. 

TABLE 5.1 



Summary of the dynamics 

in the simple spring-mass system. 


rigid-body pole: 

s = 0 


real pole: 

s = -0.37 

45 


time constant, t c = 2.73 sec. 

complex poles: 

s = -0.92 ± 1.37i 
frequency = 0.26 Hz 
damping ratio = 0.56 


complex zeros: 

s = -0.20 ± 0.98i 
frequency = 0.16 Hz 

50 — 


damping ratio = 0.20 


FIGS. 40a to 40 d illustrate the time-optimal command for 
the spring-mass system, as derived in section 4.5, and its 
corresponding robustness or insensitivity curves. For each of 
55 the insensitivity curves, the amount of residual vibration as 
a percentage of the total rigid-body motion of the system, 0.5 
m, is plotted versus the frequency of each pole and zero. 
Each of these plots assumes that all system dynamics, other 
than the pole or zero under consideration, are modeled 
60 perfectly. The first insensitivity curve in FIG. 40 b maps the 
insensitivity of the time -optimal command to variations in 
the system real pole. As expected, when the frequency of the 
system pole is identical to its modeled value, f=l/(2jtt c )= 
0.0582 Hz, the amount of residual vibration is zero. In the 
65 second and third insensitivity curves in FIGS. 40c and 40d, 
respectively, similar behavior is demonstrated for variations 
in the system complex poles and complex zeros. 
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By creating a new system with one additional pole at each 
of the complex poles in the spring-mass system, the proce- 
dure for deriving time-optimal commands was used to create 
a new time-optimal command. This time-optimal command, 
when applied to the original spring-mass system, can be 
used to deliver time -efficient performance with improved 
robustness to uncertainties in the system complex mode. 
This robust, time -optimal command profile and the corre- 
sponding system response is shown in the plot of FIG. 41 a. 
As this result illustrates, the robust, time-optimal command 
can deliver better robustness at the price of increasing the 
system response time by about a factor of two. Since this 
command was designed to be robust only to variations in the 
complex pole, the insensitivity curve for the complex pole, 
shown in FIG. 41c, shows greatly enhanced robustness. As 
enforced by the robustness constraint equations, this curve 
has zero slope and zero value at the nominal pole frequency. 
For the real pole and the complex zero (see FIGS. 41 b and 
414 respectively), on the other hand, the robust, time- 
optimal command only demonstrates slightly improved 
robustness. Since the command profile was not designed 
with these dynamics in mind, this result is not surprising. 

In order to create a time-efficient command profile with 
robustness to both the real and complex system poles, a new 
system can be created with a double pole at each of these 
poles locations. When the time-optimal command is derived 
for this new system and applied to the original spring-mass 
system, it should effect the desired system output behavior 
with greater insensitivity to variations in the system denomi- 
nator dynamics. This robust, time-optimal command profile 
and the resulting system response is illustrated in FIG. 42 a. 
As this result demonstrates, in order to make the command 
profile robust to variations in both the real and complex 
mode, the system response time increases by about a factor 
of three over the time-optimal command. As the insensitivity 
curves in FIGS. 42 b, 42 c and 42 d illustrate, however, this 
command has much improved robustness for both system 
poles. Not surprisingly, the insensitivity curve for the system 
zero shows little improvement. 

5.2 Designing Commands with a Limited Tail Length 

For systems that contain both poles and zeros, the system 
response time can be greatly reduced by designing a time- 
optimal command with a tail. This tail excites the system at 
the frequency of the system zeros while keeping the system 
output at rest at its desired final value. This extra degree of 
flexibility in the solution space of the time-optimal com- 
mand profile allows for shorter command lengths that 
improve the system’s speed of response. In many 
applications, it is undesirable to have a tail that drives a 
system after the output has reached its desired final value. 
Furthermore, if the frequencies of the system zeros are not 
known exactly, this tail will cause problematic residual 
response in the system output. In order to avoid this 
situation, it is important to have a command derivation 
scheme that allows the length of the command tail to be 
limited. This section presents an approach that can be used 
to this end as well as a demonstration of its performance on 
a simple system. 

As a necessary condition for maintaining the system 
output at its final value, the only acceptable profile for the 
tail of a time-optimal command is a linear combination of 
the initial condition response at the components of the 
system zeros. In other words, 


^ z-tt t ) (5 - 6) 

« c j e j( " f( f “ r »)> 

j= 1 

5 

for t^t„, where c } - are the tail coefficients, z - are the modeled 
values for the system zeros, and r is the number of system 
zeros. Clearly, from this equation, the only way to limit the 
length of the tail is to limit the value of the coefficients, c-. 
io One possible approach for imposing this constraint is to 
place a limit on the amount of time it takes for a command 
tail to settle within a certain specified envelope. For 
example, if it is desired to have the tail settle to within 5% 
of the actuator limits, u hm , by a time seconds after t n , the 
!5 following equation can be enforced: 

' ( 5 . 7 ) 

2_j c J e CjWnjtf ~ °-°5w]i m , 
j = i 

20 

where is the real component of the system zero, z-. 

This equation constrains the sum of the envelopes that 
bound the time-response of the tail components to settle 
within a given level in a specified amount of time. Since this 
25 constraint equation is expressed in terms of the command 
parameters, c y, it can be easily incorporated into the solution 
framework outlined in section 3 of this document. 
Specifically, by appending equation 5.7 to the three other 
problem constraints that ensure time-optimality, namely the 
30 dynamics cancellation, boundary conditions, and actuator 
limit constraints, the general solution procedure can be used 
to create time -efficient commands with a tail length tailored 
to the specific application at hand. 

FIG. 43 a illustrates some of the command solutions that 
35 were derived using this tail-length constraint for the same 
spring-mass system of FIG. 32 a. In particular, FIGS. 43 a to 
43d compare the time-optimal command, in FIG. 43 a, to 
three other commands with differing tail lengths. In FIG. 
43 b, the tail length was constrained to settle to within five 
40 percent of the actuator limits in twelve seconds. As this 
command profile and the resulting system response 
illustrate, a command with a smaller tail can be created at the 
expense of lengthening the system response time. 
Additionally, this command also contains two more switches 
45 than the time-optimal profile. Since the presence of zeros in 
a system can reduce the number of switches required in the 
time-optimal command, when the influence of these zeros is 
lessened by reducing the tail length, it is not surprising to see 
the number of command switches increase. The plot in FIG. 
50 43c illustrates the command profile that resulted from a six 
second time limit on the length of the tail. As expected, this 
command has a tail of lower amplitude and length but a 
longer pulse train. In the last plot of FIG. 43d, the tail 
coefficients were constrained to be zero. Recalling the 
55 example from section 4.5, this command profile corresponds 
to the time -optimal control for an equivalent system with the 
zeros removed. This last result illustrates that if a command 
with no tail is desired, a designer can take a given system 
model, remove the zeros while keeping the same steady- 
60 state gain, and use the solution procedure from section 3 of 
this document to derive a time-optimal command profile. 
The resulting time -optimal command for the augmented 
system will be the shortest possible command that can 
deliver the actual system from its initial to its final value 
65 without the presence of a tail. 

FIGS. 44, 45 and 46 illustrate the insensitivity curves of 
the four commands in FIGS. 43a to 43d to variations in the 
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system dynamics. From the curves in FIG. 44 and FIG. 45, 
it can be seen that reducing the tail length of a command 
profile influences the robustness to uncertainties in system 
denominator dynamics in no appreciable manner. In FIG. 
46, however, and as discussed in section 5.1.2, by reducing 
the tail length of the optimal command profiles, the robust- 
ness to uncertainties in system zeros can be enhanced. As the 
curve for the command with no tail illustrates, infinite 
insensitivity to variations in system zeros can be achieved if 
the tail is eliminated altogether. 

5.3 Other Constraints 

This section has illustrated that the solution framework 
presented in this document is not simply an approach for 
finding time-optimal command profiles. Instead, it can be 
viewed as an expandable framework capable of incorporat- 
ing many different kinds of constraints to enrich command 
performance. For example, in systems that have limited fuel, 
designers may with to place constraints on the fuel usage of 
a command profile. This can often be accomplished by 
creating a constraint that penalizes the amount of time that 
the actuators are saturated. Similarly, in some systems that 
require gentle yet fast motion, deflection limiting constraints 
can be incorporated to limit the internal loads and resulting 
machine deflection during operation. Lastly, in systems 
where unmodeled modes may be excited by bang — bang 
command profiles, a constraint can be imposed to keep the 
amplitudes of the steps in the command pulse train to be 
greater than zero. The staircase commands that result from 
this solution approach will be identical to commands derived 
using the input shaping technique and can be used to achieve 
robust and rapid motion in many systems. 

6 Solving for and Verifying Time-Optimal Commands 

To this point, we have presented a general solution 
approach for the time-optimal control problem and illus- 
trated methods for extending this technique for deriving a 
wider class of time-efficient commands. This methodology 
relies on formulating a compact and complete set of con- 
straint equations that can be solved to find optimal command 
solutions. For most systems, this solution step must be 
accomplished using an optimization routine to search 
through the set of possible command solutions. This section 
is devoted to discussing one possible process for numeri- 
cally searching for time-optimal and time-efficient com- 
mand profiles. Furthermore, since numerical approaches can 
sometimes return non-optimal solutions, a process is also 
discussed in this chapter for verifying the optimality of 
command solutions. This combination of an efficient solu- 
tion search routine and verification process provides a 
powerful tool for identifying optimal commands for linear 
systems. Following the individual discussion of these two 
solution components, some general statements will be made 
about the performance of these processes and their effec- 
tiveness at deriving time-optimal and time -efficient com- 
mand profiles. 

6.1 Optimization Process to Find Time-Optimal and Time- 
Efficient Commands 

For linear systems that contain more than one or two 
poles, time-optimal and time-efficient solutions must be 
derived numerically using an optimization process. In 
general, as discussed in section 3, since the fundamental 
constraint equations for this problem can be expressed 
algebraically in a simple and compact form, numerical 
optimization of these constraints proves to be fast and 
reliable. This section presents a possible process that can be 
used to generate optimal command solutions using a numeri- 
cal optimization process. 

FIG. 47 illustrates a computer-executable process for 
numerically identifying time-optimal and time-efficient 
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commands. As this figure depicts, the procedure begins with 
a given linear, time -invariant system and a set of problem 
specifications. From this point, the remaining solution steps 
can be categorized into the three basic solution stages that 
5 surface throughout this document: (1) select a candidate 
command profile in step S4701, (2) impose the problem 
constraints in step S4702, and (3) solve and verify in step 
S4703. 

In the first stage of this procedure in step S4701, the given 
system model and problem specifications are used to iden- 
tify parameters which describe a candidate optimal com- 
mand profile. In particular, the system actuator limits can be 
used to designate values for the command pulse train 
amplitudes and any zeros can be identified from the model 
and included as parameters for the command tail. For the 
15 command switch times and tail coefficients, since they are 
unknown prior to optimization, and initial guess must be 
made for each of their values. In the case of the tail 
coefficients, an initial value of zero is not a bad place to start. 
For the command switch times, however, initial estimates 
20 are somewhat more critical. In this case, the first guess 
which must be submitted is the number of switches that the 
candidate command must contain. As outlined in section 
2.3.3, the minimum number of switches, not including the 
first and last, that any command must have is equal to 
25 (n-l)-r, where n is the number of system poles and r is the 
number of system zeros. For a system with no complex 
modes, the upper bound on the number of switches is exactly 
(n-1). In general, in order to select the number of switches 
to include in the initial guess, it is better to select more 
30 switches than the optimal command will require. The reason 
for this is that, when an optimization routine has too few 
switches in a candidate command, there will be no viable 
solution that satisfies the problem constraints. However, if 
the candidate command has extra switch times, a good 
35 optimization strategy can typically merge the redundant 
command switches to create an optimal command with the 
correct number of switch times. As a starting point, (n-1) is 
typically a good initial guess for the number of command 
switches. For systems with complex modes and long move 
40 distances, the designer may want to consider increasing this 
value by one or two. 

Once an initial number of switches is selected, initial 
estimates for the value of each switch time must be made. 
This step, in many cases, relies on the intuition of the 
45 designer to select reasonable values given the system param- 
eters. Fortunately, for systems of small to moderate 
complexity, optimization processes are typically forgiving 
when faced with poor initial guesses. For the examples in 
this document, initial guesses were typically derived by 
50 using a technique from input shaping. In particular, the 
approach outlined in [114] was used to create non-time- 
optimal bang — bang commands that satisfied the identical 
problem constraints. The values for these non-optimal 
switch times were then used as initial guesses for creating 
55 time-optimal and time-efficient commands. For many 
systems, this approach worked very well, however, for some 
more complex systems, different initial guesses were 
required. One effective approach for proposing initial 
guesses for complex problems is to derive commands for 
60 simplified versions of the same system. By constructing 
commands of increasing complexity, the switch times from 
each solution can be used to enlighten the initial guesses for 
each successive system. By capturing the logic of this 
approach and translating it into a formal procedure, it seems 
65 likely that a technique can be developed for creating reliable 
initial guesses that fully automate the command solution 
process. 
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The second stage in the solution procedure depicted in 
step S4702 is to impose the problem constraints. Discussed 
thoroughly in previous sections, this step is as simple as 
encoding the general expressions derived in section 3. Also, 
for systems with problem constraints beyond the basic 
time-optimal equations, additional expressions can be 
appended to this list as described in section 5. For the 
process used to solve the examples in this document, an 
efficient matrix notation, described in section 3, was 
employed to code the general constraint equations. Given 
the simplicity of the resulting expressions, this task can be 
achieved with little effort. 

The third and final stage of the solution procedure, in step 
S4703, is to solve for the optimal command solution and 
verify the result. By enlisting the help of a commercial 
optimization package such as the Matlab Optimization Tool- 
box [215, 218] or GAMS [219], the first part of this stage is 
easy to achieve. Specifically, such an optimization process 
can be used to find the set of command switch times and tail 
coefficients that satisfy all of the constraint equations as well 
as minimize the time-length of the command. For the 
examples in this document, a constrained nonlinear optimi- 
zation routine from the Matlab Optimization Toolbox was 
employed. This process relies on a Sequential Quadratic 
Programming method to search for optimal solutions. Since 
this and similar optimization approaches may return local 
solutions rather than global optimal solutions, a verification 
stage to the solution approach can be very valuable. Such a 
verification scheme, which is discussed in detail in the 
following section, was developed and implemented to check 
the validity of time-optimal command solutions. This 
scheme relies on PontryaguTs Minimum Principle to outline 
a set of necessary and sufficient conditions that the time- 
optimal command must satisfy. For every command solution 
that is returned by the optimization routine, these conditions 
can be invoked to verify its optimality. If they are satisfied, 
then the command is guaranteed to be the unique time 
optimal solution for the given problem. If not, then the 
solution process can be rerun with a different initial guess 
until the optimal command profile is found. 

In order to streamline the creation of time-optimal and 
time-efficient command profiles for various systems, the 
graphical user interface to the solution code shown in FIG. 
48 was constructed. This interface takes a given linear 
system model and lists all of the system poles and zeros. 
From this point, the designer can specify a number of 
options such as the exact problem specifications, the desired 
robustness at each system pole and zero, and the desired 
length of the command tail. If desired, upon creation of the 
command profile, different plots can be displayed demon- 
strating various aspects of the command performance. 

6.2 Verifying Optimality Using Pontryagin’s Minimum 
Principle 

As mentioned above, an approach for verifying the time- 
optimality of bang — bang commands can be constructed 
from the conditions outlined in PontryaguTs Minimum 
Principle. This section builds on prior approaches and 
describes in detail how they can be applied to the solution 
methodology outlined in the previous section. This section 
proceeds by presenting first a brief review Pontryagin’s 
Minimum Principle followed by a general five-step proce- 
dure for applying this principle to verify time-optimality. 
6.2.1 A Review of PontryaguTs Minimum Principle 

PontryaguTs Minimum Principle has been applied widely 
to solve time-optimal problems for both linear and nonlinear 
systems. This section will begin with a presentation of the 
principle for the more general nonlinear case and then 


explain how it can be simplified for linear systems. Note 
that, for the equations in this section, the notation ( )* 
indicates that the value in the parenthesis is that of the 
time-optimal solution, and the notation ( )|* indicates that 
5 the value in the parenthesis is evaluated using time-optimal 
values. 

The general form of PontryaguTs Minimum Principle for 
the time -optimal control problem can be stated as follows. 
Given a controllable system, 

10 

x'=f(x, u), (6.1) 


where 


15 x=x(t)sstate vector, and 
u=u(t)scontrol vector, 

the control vector, u(t), that will transition the system from 
a fixed initial state, x 0 , to a fixed final state, x d , in minimum 
time must necessarily satisfy the following conditions: 

20 1. The Canonical Equations: 


dH 

state equation; x* = — — 
dp = 


(6.2) 


dH 

25 costate equation; p* = - —— , where 


(6.3) 


m 

H = Hamiltonian^ ^ Pifi(x, u ), 


(6.4) 


30 

m is the number of system states, and p,- and f,- are the i-th 
elements of the vectors p and f, respectively. 

2. Minimization of the Hamiltonian: 

For all admissible controls (i.e. controls that remain 
35 within the actuator limits), u(t), 

H(x *,p*, w*)= H(x *,p * u) . (6.5) 

In other words, there is no control input, u(t), other than the 
optimal control, u(t)*, that will yield a lower value of the 
Hamiltonian, H. 

3. Value of the Hamiltonian: 

For all values of t in the interval from t o =0 to t=t n *, where 
t n * is the time length of the optimal control input, 

45 0. (6.6) 

Given this general form of PontryaguTs Minimum Principle 
for time-optimal commands, the conditions can be further 
simplified by considering only linear, time -invariant sys- 
50 terns. More specifically, given a system of the form 


x'=Ax+Bu, 


(6.7) 


where 


x=x(t) estate vector, and 
u=u(t)=control vector, where 

A and B are constant matrices that describe a completely 
controllable system, then the time-optimal control problem 
is to find the control, u(t), that will satisfy the following two 
conditions in minimum time: (1) it must remain within 
actuator limits, 


»««=»(*) =*w » (6-8) 

65 and (2) it must transition the system from the known initial 
state, x 0 at t=0, to a desired fixed final state, X d . The reduced 
form of PontryaguTs Minimum Principle states that the 
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optimal control, u(t)*, that solves this problem must neces- 
sarily satisfy the following three conditions: 

1. The Canonical Equations: 


x* = 


dH 

dp 


Ax* + Bu* 


P* 


dH 

dx 


= - A T p * = -p* T A 


(6.9) 

( 6 . 10 ) 


2. Minimization of the Hamiltonian: 

For all admissible controls, u(t), 

H{x*p* u*) %H(x*p* u ). (6.11) 

Now, since 

H=l+p T x=l+p T Ax+p T Bu, (6.12) 

this condition becomes 

l+p* T Ax*+p* T Bu*^l+p* T Ax*+p* T Bu, (6.13) 

for all admissible u(t) on the interval from t 0 to t„*. It can be 
seen that this relation will be true when 


and normal. If not, then the conditions in PontryaguTs 
Minimum Principle do not guarantee that a time-optimal 
solution will exist or be unique. 

Step S4902: If the time-optimal command is designed 
5 correctly, it will deliver the system output from its initial 
state to the desired final state. This can be verified by 
solving or simulating the state equation, equation 6.9, in 
condition 1. 

Step S4903: In order to satisfy the second condition of 
10 Pontryagin’s Minimum Principle, namely that the Hamil- 
tonian must be minimized over the time length of the 
optimal command, the value of the function p(t) r Bu(t) 
must be minimized over the time length of the command. 
Therefore, in order to be optimal, u(t) must be at the 
15 minimum actuator value when the switching function, 
p(t) r B, is greater than zero and the maximum actuator 
value when p(t) r B is less than zero. Also, since p(t) r B is 
a smooth function, it must be equal to zero at the exact 
locations of the switch times of the proposed optimal 
20 command. Now, in order to calculate the switching 
function, the value of p(t) must first be determined. This 
can be done by solving the costate equation, equation 
6.10, in condition 1 to produce the expression 


»(0 *=«*.■* for ?( 9 *>°> 


and 


»(0 *=«*«» for 


25 P( { ) =e aT ‘Po> ( 6 - 16 ) 

where p 0 is the initial value of the costate vector. This 
result can be substituted into the expression for switching 
function, q(t), as in equation 6.14, to yield 


where q(t)* is called the switching function and is defined as 

q(t)*=p(t)* T B=B T p(i)*. (6.14) 

3. Value of the Hamiltonian: 

For all values of t in the interval from t 0 to t n *, 

H=l+p* T Ax*+p* T Bu*=Q. (6.15) 

In addition to outlining the three conditions for optimality 
stated above, PontryaguTs Minimum Principle also asserts 
that, if the system described by A and B is stable, and both 
the initial state, x 0 , and the final state, x d , are natural 
equilibrium states of the system, then a time-optimal control 
will always exist. Furthermore, if the final state, x d , is not a 
natural equilibrium state but can be reached by an admis- 
sible control, then a time-optimal control will also always 
exist. If in addition to being controllable, the given system 
is also normal (i.e. the system is controllable from every 
input), then the time-optimal control, if it exists, is also 
unique. Therefore, as a summary of the scope of Pontrya- 
guTs Minimum Principle, for linear, time-invariant systems 
that are normal, stable and have a desired change of state that 
can be effected by an admissible control, the time -optimal 
control exists, is unique, and must necessarily satisfy con- 
ditions 1, 2, and 3. 

6.2.2 Procedure for Verifying Time-Optimality Using 
Pontryagin’s Minimum Principle 

As outlined above, PontryaguTs Minimum Principle 
establishes a set of necessary and sufficient conditions that 
a time-optimal command must satisfy. While these condi- 
tions do not suggest a straightforward way to derive optimal 
command profiles, they do lend insight into a simple pro- 
cedure that can be used for verifying the optimality of 
commands created using other methods. This verification 
procedure is illustrated in FIG. 49 and described in detail 
below. 

Step S4901: The first step for checking optimality is to 
verify that a given linear, time-invariant system is stable 


30 q{i)=B T e~ ATt p 0 . (6.17) 

Since the value of p 0 corresponding to the optimal solu- 
tion is unknown, this equation cannot be used to calculate 
the switching function. However, since we know that this 
35 function must be zero at the locations of the command 
switch times, the proposed optimal command will only be 
optimal if 

q{i)=B T e~ A \ = 0, (6.18) 

40 where t y are the values of the switch times in the candidate 
command, excluding t 0 and t n . From this result, it can be 
seen that this expression can be evaluated for every switch 
time and the resulting set of equations can be solved to 
find all initial costate vectors, p 0 , that satisfy these equa- 
45 tions. If no initial costate vectors exist that satisfy this set 
of equations, then the proposed command is not time- 
optimal. 

Step S4904: Once a set of initial costate vectors that satisfy 
equation 6.18 has been identified, the one which corre- 
50 sponds to the unique time-optimal command solution 
must be isolated. Condition 3 in PontryaguTs Minimum 
Principle can be used as the first metric for assessing the 
optimality of these initial costate vectors. As in equation 
6.15, this condition asserts that the optimal command 
55 must result in a Hamiltonian that is zero over the time 
length of the command. This can be verified by calculat- 
ing the Hamiltonian for each initial costate vector. Note 
however that equation 6.18 can only be used to determine 
the direction of the initial costate vectors, not the mag- 
60 nitude. As a result, each candidate initial costate vector 
can also be scaled by an arbitrary constant and still satisfy 
equation 6.18. Given this, it can be seen from the expres- 
sion for the Hamiltonian in equation 6.15 that, in order to 
yield a Hamiltonian that is zero, the following relation 
65 must hold: 


p* T Ax*+p* T Bu*= constant. 


(6.19) 
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If this expression is satisfied by any of the candidate initial 
costate vectors, their magnitude can be scaled appropri- 
ately to also satisfy equation 6.15. If any of the initial 
costate vectors do not satisfy this expression, they cannot 
be optimal and must be eliminated from consideration. 
Step S4905: The final step in verifying the optimality of a 
command profile is to use the initial costate vectors that 
fulfilled step 4 to calculate a switching function, as in 
equation 6.14. In order to be optimal, the resulting switch- 
ing function must be zero at only the values of the 
command switch times. If the switching function has a 
fewer or greater number of values where it is zero, it 
cannot be optimal. If a nontrivial solution exists that 
satisfies this condition, then it is guaranteed to be the 
unique time-optimal solution. 

The foregoing five-step verification procedure can be 
applied to validate time-optimal commands for linear, time- 
invariant systems, and as a result, it proves to be a valuable 
companion to any command solution process. The useful- 
ness of this approach does not end there, however, since this 
approach can also be applied to robust, time -optimal com- 
mands and commands with tail-length constraints. For the 
case of robust, time-optimal commands, section 5 reveals 
that the robust, time-optimal command for a given system is 
equivalent to the time-optimal command for a similar sys- 
tem with additional poles at the locations of the uncertain 
system modes. Following this reasoning, it can be seen that 
the verification scheme can also be applied in this case to 
ensure that the robust, time-optimal command is indeed the 
time-optimal command for the augmented system model. 

For commands that have tail length constraints, this 
scheme can be used as well. Specifically, as described above, 
Pontryagin’s Minimum Principle only places restrictions on 
the bang — bang portion of the optimal command profile. For 
commands that contain a tail, typically the pulse train of the 
command can be shortened due to the additional flexibility 
in the allowable final state of the system. For a specified 
system final state, Pontryagin’s Minimum Principle can 
identify the unique time-optimal command that will deliver 
the system there, but it makes no claims on what this optimal 
final state should be. By relying on the command solution 
scheme in section 6.1 to identify what the optimal final 
system state should be, the verification scheme can then be 
used to guarantee that the command pulse train is indeed 
optimal for delivering the system to this final state. 

6.3 A Statement on the Performance of the Solution 
Approach 

By combining a straightforward solution methodology 
with a verification scheme, a hybrid approach can be created 
that can reliably deliver time-optimal and time-efficient 
solutions for linear systems. Since the governing constraint 
equations in this approach are algebraic by nature, solutions 
for many systems can be reached quickly and reliably. 
Additionally, by employing a computationally efficient veri- 
fication scheme, these solutions can be guaranteed to be 
optimal. The exact amount of time required to reach solu- 
tions using this procedure depends on both the system 
complexity as well as the quality of initial guesses for the 
command parameters. For systems that have fewer than 
around five poles, optimal commands can typically be found 
within a few seconds. In most cases, the solution process 
delivers and verifies the solution on the first iteration. For 
more complex systems, such as ones that contain five to 
fifteen poles, solution times are very much related to the 
accuracy of the initial guess. In the best case, solutions can 
be found immediately, and in the worst case, solutions could 
require dozens of iterations to locate the optimal solution. 
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For systems that are more complicated than these, finding 
time-optimal solutions can be tedious and unreliable. With 
greater attention to numerical conditioning and better initial 
estimates, this problem may be solvable. However, since 
5 time -optimal commands typically have little energy at 
higher system modes, commands designed for fewer than 
five system modes often prove to be more than adequate for 
delivering the desired performance upon implementation. 

7 Experimental Results 

10 Using the general solution process outlined in the previ- 
ous chapter, time-optimal and time-efficient commands can 
be easily derived for a wide range of linear systems. As the 
examples in section 4 attest, the commands derived using 
this approach work effectively on linear system models. In 
15 order to truly demonstrate the effectiveness of this 
technique, however, implementation on hardware is 
required. In order to accomplish this, several experiments 
were run on a mechanical testbed designed for the Middeck 
Active Control Experiment. Originally constructed for a 
20 Space Shuttle flight experiment, this hardware was designed 
to be representative of a highly flexible space satellite. 
Consequently, the structure contains a lightly damped fun- 
damental bending frequency below 2 Hz and four dominant 
flexible modes below 10 Hz. Because of these complex 
25 system dynamics, evaluating command profiles as well as 
control designs on this testbed is in some ways a trial by fire. 
However, if these command profiles can display acceptable 
performance on this experimental platform, then they can 
likely be implemented with much success on many other 
30 kinds of systems. 

This section proceeds by first presenting an overview of 
the MACE experiment, including a discussion of the experi- 
ment goals and research efforts. Following this description, 
experimental results will be presented for the implementa- 
35 tion of time-optimal and time-efficient commands on the 
MACE hardware. From these experimental results, it will be 
demonstrated that the command profiles derived using the 
approach in this document can be effectively applied to real 
physical systems. 

40 7.1 The MACE Experiment 

The purpose of MACE is to develop and verify a set of 
techniques that can be used to give designers of spacecraft, 
which cannot be tested adequately on the ground, confidence 
in eventual on-orbit performance. To achieve this objective, 
45 the MACE hardware, as shown in FIG. 50, was flown aboard 
the space shuttle Endeavour in March of 1995. Using this 
experimental platform, three main tasks were performed to 
investigate modeling and control design in a zero-gravity 
environment. First, controllers and shaped inputs, which 
50 were designed prior to flight using ground-based modeling 
efforts, were implemented. Second, a system identification 
was performed on-orbit and the resulting ID data was 
down-linked and used to formulate new controllers and 
shaped inputs. Last, these new controllers and inputs were 
55 up-linked during the mission and implemented on the 
MACE hardware. A more detailed overview of the MACE 
project is available in [220-222]. 

7.1.1 The MACE Hardware 

The MACE test article was designed to be representative 
60 of a typical precision-controlled, high payload-mass- 
fraction spacecraft, such as an Earth-observing satellite, with 
multiple independent scanning or pointing instruments. As a 
result, the MACE hardware, as shown in FIG. 50, consists 
of a five-foot-long flexible bus with a gimbal at each end. 
65 Actuated by direct-drive DC torque motors, each of the two 
gimbals can move its payload around two perpendicular 
axes. The MACE bus is constructed from four tubular 
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polycarbonate struts, one of which contains piezoelectric 
material to actuate bending strain in the structure. In addition 
to these actuators, a re action- wheel assembly is located in 
the center of the MACE structure to provide attitude control 
of the test article. This assembly is comprised of three 
orthogonally mounted inertia wheels driven by DC servo 
motors. 

In order to closely monitor open- and closed-loop 
performance, the test article is outfitted with a variety of 
sensors. Specifically, each gimbal axis has a laser rotary 
encoder to measure the angle of the gimbal relative to the 
bus. Also, a two-axis rate-gyro platform is mounted on the 
payload arm of the primary gimbal while a three-axis 
rate-gyro platform measures bus rotation at the reaction- 
wheel assembly. Last, eight pairs of strain gages are 
mounted on the bus links, two per strut, to monitor the 
vertical and horizontal bending strains in the structure. 

All electronics for collecting sensor data and controlling 
actuators reside in the MACE Experiment Support Module 
(ESM). In addition to harboring a DSP-based real-time 
control computer to implement control processes, the ESM 
contains analog servos for the reaction wheels, rate-gyro 
notch filters, sensor anti-aliasing filters, as well as all data- 
acquisition electronics. Using the DSP board and feedback 
from encoder rate signals, all four gimbal motors are con- 
trolled by SISO proportional-integral servos. During 
experiments, the control computer is capable of sending 
predetermined commands to the gimbal actuators while 
simultaneously running a MIMO high-performance control- 
ler. All controllers are run at a 500 Hz sampling rate. 

Both before and after flight, the MACE hardware was 
ground-tested thoroughly. In an attempt to replicate 0-g 
behavior in a 1-g environment, the entire structure is sup- 
ported on a pneumatic-electric active suspension. This sus- 
pension supports the structure at the bus center and both 
ends and is designed to have low-frequency rigid-body 
modes well below 1 Hz. 

7.1.2 MACE Modeling and Control 

The design of high-performance command profiles and 
controllers for MACE rests heavily on the development of 
accurate models. Since the exact behavior of the MACE 
structure in 0-g could not be measured prior to flight, a 
finite -element model (FEM) to predict the on-orbit behavior 
was created using ground-based testing of the flight hard- 
ware. Specifically, a parameter-based FEM was developed 
to replicate the behavior of the MACE hardware as sup- 
ported by the active suspension in 1-g. The open- and 
closed-loop behavior of this model was then compared to 
that of the actual structure in order to refine the model and 
verify its validity. When the 1-g FEM was sufficiently 
accurate, the 0-g model was created by removing gravity and 
the suspension system from the 1-g model. The resulting 0-g 
model, which contained 130 states and 13 modes below 20 
Hz, represented the best available predictor of real on-orbit 
behavior for MACE. A detailed account of MACE finite - 
element modeling work can be found in [223-226]. 

The second aspect of the MACE modeling effort was the 
creation of measurement-based models using actual system 
identification data. Since these measurement-based models 
were derived directly from the experimental data, they 
proved to be highly accurate predictors of system behavior. 
As a result, they were also used as a baseline from which the 
accuracy of the finite-element models could be measured. In 
particular, the measurement-based system-identification to 
be performed on MACE employed the Frequency Domain 
Observability Range Space Extraction (FORSE) technique, 
as described in [227, 228] to convert frequency-domain data 
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into a state-space system model. During the MACE mission, 
this process was applied to on-orbit data to create a highly 
accurate 0-g models which were used to design some of the 
controllers and command profiles implemented during the 
5 flight. The results of these redesigned experiments were used 
to understand the value of on-orbit system identification for 
maximizing 0-g performance. 

The success of MACE was evaluated in part on its ability 
to exhibit high-performance structural control in a zero- 
10 gravity environment. Reaching this goal depended not only 
on accurate 0-g models but also on control-synthesis tech- 
niques that were robust to errors in these models. To address 
this issue, modern MIMO robust-control processes, such as 
Sensitivity Weighted Linear Quadratic Gaussian (LQG) and 
15 Multiple Model (MM) control, were implemented during the 
MACE mission. The performance of these controllers was 
measured by their ability to isolate the primary gimbal from 
vibrations in the test article excited by the secondary gimbal. 
More detail on the control techniques used on MACE can be 
20 found in [229-233], and an overview of the closed-loop 
mission results is presented in [234]. 

In addition to evaluating closed-loop control techniques in 
zero-gravity, the MACE testbed was also used to assess the 
performance of feedforward control techniques such as input 
25 shaping. During the mission, several different types of 
time-efficient command profiles were used to execute gim- 
bal slewing maneuvers while suppressing system vibration. 
A detailed account of these experiments and the mission 
results can be found in [181, 235, 236]. 

30 7.2 Experimental Data 

A set of experiments was conducted on the MACE test 
article to evaluate the performance of time -optimal and 
time-efficient commands created using the approach out- 
lined in this document. For each of these experiments, the 
35 goal was to slew the MACE gimbal payload over an angle 
of about one degree and bring it to rest as quickly as 
possible. To accomplish this task, setpoint commands were 
sent to the gimbal servo and the resulting gimbal pointing 
angle was measured by a rate gyro. 

40 In order to design optimal command profiles for the 
MACE structure, a linear system model was required. As 
described above, for the original MACE mission, a 156-state 
linearized FEM model was constructed to describe the test 
article in 1-g. This model was used to simulate the MACE 
45 gimbal response in all experimental trials. In order to design 
time-optimal commands, however, it was first necessary to 
reduce this model. As discussed in section 6.3, bang — bang 
commands for most systems work effectively when designed 
for only a few dominant system modes. In the case of the 
50 MACE test article, only the first four dominant system 
modes were considered. Using a balanced model reduction 
process, the 156-state MACE model was reduced to an 
8 -state model. The dynamics of this reduced model, which 
are summarized in Table 7.1, included four flexible modes 
55 and four complex zero pairs. Given values for the important 
system poles and zeros, several types of commands were 
designed to effect the desired gimbal slewing angle. 

The first command profile evaluated on the MACE test- 
bed was a simple step command. As the results in FIG. 51 
60 illustrate, when a step command is sent to the gimbal servo 
to effect the desired change in gimbal angle, substantial 
lightly damped vibration is excited in the MACE structure 
which corrupts the pointing accuracy of the gimbal. As a first 
measure to remedy this poor performance, designers often 
65 employ smoothed commands such as splines to minimize 
residual vibration. As illustrated in FIG. 52, these commands 
can be effective at reducing problematic vibration but typi- 
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cally introduce a substantial lag in the system response. A 
better approach for eliminating unwanted vibration while 
ensuring rapid system response is to use the input shaping 
technique. In FIG. 53, the simulated and experimental 
gimbal response is shown for a command profile created by 5 
shaping a step command with an input shaper. The input 
shaper used in this experiment was designed to suppress 
vibration at the first four system modes with the minimum 
level of robustness to dynamic uncertainty. As the experi- 
mental results for this command illustrate, with a system 
response time of about 0.6 seconds, input shaping proves 
effective at delivering the gimbal to its final angle with little 
residual vibration. 


TABLE 7.1 

Summary of the modes used to design the MACE command profiles. 


frequency (Hz) damping ratio 


MACE poles: 

1.55 

0.04 


3.86 

0.22 


4.03 

0.46 


7.43 

0.03 

MACE zeros: 

1.60 

0.05 


4.52 

0.14 


7.39 

0.04 


11.80 

0.04 


15 


20 


25 


If speed of system response is not an important perfor- 
mance metric, the input shaping solution might be adequate 
for a given system. In time-critical applications, however, 
time-optimal commands must be employed to elicit the 30 
fastest system performance. FIG. 54 illustrates the experi- 
mental and simulated system response to a time-optimal 
command designed for a system with only the first three 
flexible modes in the MACE structure. This command was 
designed using the pole locations from the reduced system 35 
model, and the maximum and minimum amplitudes of the 
time -optimal command were set to plus and minus two 
degrees to correspond with the saturation limits of the 
gimbal motors. As the experimental response to this com- 
mand indicates, the system rise time can be reduced to about 40 

0.4 seconds, but a fair amount of residual vibration still 
remains in the response. Since this residual vibration occurs 
primarily at the frequency of the fourth system mode, 7.43 
Hz, a new time -optimal command can be designed to 
include this mode as well. Shown in FIG. 55, this four-mode 45 
time-optimal command transitions the gimbal to its desired 
final angle in just over 0.4 seconds while eliminating all but 
some small residual vibration in the higher system modes. 

In order to further reduce the response time of the MACE 
gimbal response, time-optimal commands can be designed 50 
for the system zeros as well as poles. As shown in FIG. 56, 
when a time-optimal command is designed for the four pairs 
of complex poles and zeros in Table 7.1, the system rise time 
can be dramatically reduced to about 0.1 seconds. The 
resulting command profile now contains five switches, 55 
including the first and last, as well as a tail with lightly 
damped vibration at the frequencies of the system zeros. 
Unfortunately, the price that is paid for this rapid system 
response is the undesirably high levels of residual vibration. 
Since this residual vibration is not present in the simulated 60 
response for the 156-state model, it can largely be attributed 
to poor command insensitivity to model inaccuracies. In 
order to improve this condition, the techniques for enhanc- 
ing command robustness discussed in section 5 can be 
enlisted. Specifically, since the residual response in FIG. 56 65 
occurs primarily at the first two system modes, a new 
time-optimal command can be designed with enhanced 


robustness for these modes. The resulting command profile, 
as shown in FIG. 57, contains a pulse train with eleven 
switches and length of about 0.4 seconds. As desired, the 
illustrated experimental response to this robust, time- 
optimal command profile shows little residual vibration at 
the end of the command. However, the increased response 
time required to obtain this measure of robustness undercuts 
the value of this command solution. 

As the experimental results presented in this section 
illustrate, system response can be significantly improved 
over conventional methods when time-optimal commands 
are employed. For the MACE test article, in particular, the 
response times showed a substantial decrease when numera- 
tor dynamics were included in the time-optimal command 
formulation. Unfortunately, due to poor command robust- 
ness in the presence of many lightly damped system modes, 
these time -optimal commands often excited undesirable 
levels of residual vibration in the system response. To 
address this issue, techniques for enhancing command 
robustness proved effective, but only at the cost of increas- 
ing the system response time. 

8 Conclusions 

This document has presented a general strategy for deriv- 
ing time-optimal and time-efficient commands for linear 
systems. As a primary component of this work, this 
approach was applied to the time-optimal control problem 
and used to derive commands for a variety of different 
systems. Additionally, by incorporating constraints to 
enhance robustness and limit tail length, it was illustrated 
that this solution method is an expandable framework that 
can accommodate a variety of performance constraints. The 
insights and conclusions presented in this work are summa- 
rized below. 

1. A straightforward three-step procedure has been pre- 
sented for deriving time-optimal and time-efficient 
commands for any type of linear, SISO system. 

2. By applying this three-step approach specifically to the 
time-optimal control problem, four primary steps were 
taken: 

The set of fundamental and general constraint equa- 
tions was derived for the time-optimal control prob- 
lem and expressed in terms of parameters describing 
the optimal command profile. 

A simple and compact notation was formed to express 
the constraint equations and streamline implementa- 
tion. 

By considering the analytic solution for the residual 
response to a time-optimal command, it was dem- 
onstrated that these equations represent the complete 
set of necessary constraints for the time-optimal 
control of a linear system. 

Since these constraint equations are algebraic by 
nature, solutions for time-optimal command profiles 
were found rapidly and reliably. 

3. This three-step solution methodology was illustrated to 
be easily extendible to systems with additional practical 
constraints. In particular, a method for improving the 
robustness of command profiles to both numerator and 
denominator dynamics was presented, and a technique 
for constraining the command tail length was also 
considered. 

4. An optimality verification scheme was developed by 
applying the conditions in Pontryagin’s Minimum Prin- 
ciple. By pairing this scheme with a numerical optimi- 
zation process, a hybrid solution approach was created 
that reliably delivers verifiably time-optimal and time- 
efficient commands. 
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5. By considering several simple examples, the time- 
optimal solution approach was demonstrated to work 
on systems with different combinations of numerator 
and denominator dynamics. As part of this 
demonstration, four specific analytic solutions for time- 5 
optimal commands were derived. 

6. Using the MACE test article, these techniques were 
implemented and validated on a complex piece of 
mechanical hardware. 

Due to the simplicity and reliability of the methodology 10 
outlined herein, time-optimal and time-efficient commands 
can now be generated for a much larger class of systems than 
previously possible. Additionally, since the general solution 
framework presented here has been shown to be easily 
expandable, engineers and designers will be able to extend 15 
the capabilities of the method to design new commands 
tailored to their specific needs. 

Many possible areas for future work lie in the develop- 
ment of new types of practical constraints that can be 
appended to this approach. For example, constraint equa- 20 
tions to regulate power consumption or system deflection 
may yield a new class of practical command profiles. 
Additionally, new ways to formulate the robustness 
constraint, perhaps by designing longer commands with 
fewer switch times, may prove useful for certain types of 25 
systems. Although a much larger problem in scope, a natural 
extension to the theory in this document is to apply the same 
solution framework to systems with multiple -inputs and 
multiple -outputs (MIMO). Any such MIMO formulation can 
adopt a similar constraint-optimization approach, but the 30 
constraint equations themselves will require a different form 
with better numerical conditioning properties. 

The present invention has been described with respect to 
a particular illustrative embodiment. It is to be understood 
that the invention is not limited to the above -described 35 
embodiment and modifications thereto, and that various 
changes and modifications may be made by those or ordi- 
nary skill in the art without departing from the spirit and 
scope of the appended claims. 

40 
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Appendix A 

In this appendix, a general analytic expression is derived 

for the residual response of a linear system to a time-optimal 

or time-efficient command profile. As discussed in section 5 
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above, this expression is very useful for characterizing the 
amplitude of residual response that results due to modeling 
uncertainties. Additionally, as will be illustrated at the end of 
this derivation, the terms of this expression can be used to 
5 argue that the constraint equations specified in section 3 
above are the minimum necessary set required to bound the 
time-optimal control problem. 

Nomenclature 

Before the derivation begins, we must first define some 
10 variables and concepts. First, as is the convention in this 
work, the residual response will be derived for the standard 
time-optimal or time-efficient command profile described in 
section 3 and depicted in FIG. 14. This command profile 
consists of a pulse train with a finite number of switches 
15 followed by a tail. The term “residual response” itself refers 
to the system behavior after the command pulse train is 
complete. As a general rule, the equations derived here will 
only apply to the system response for times t=^t„, where i n 
is the time of the final switch in the command pulse train. 
20 For all of the steps of the derivation, several variables are 
required to describe the system dynamics and command 
profile. Definitions of these variables, for a given linear 
system and a given time-optimal or time-efficient command 
profile, are summarized below: 

25 System Variables: 

m^the total number of system poles, 
r^the total number of system zeros, 
rbm^the number of system rigid-body modes, 

30 p.sthe system poles, where i=l, 2, . . . , m, 

q.sthe multiplicity of the system poles, where 
i=l, 2, . . . , m, and 

Zysthe system zeros, where j=l, 2, . . . , r. 

Command Profile Variables: 

35 n=the total number of switches in the command pulse 
train minus one, 

a^-sthe amplitude of the steps in the pulse train, where j=0, 
1, . . . , n, 

t.-sthe switch times of the pulse train, where i=0, 1, , 

40 } 5 

n, 

Cysthe coefficients of the exponential terms in the com- 
mand tail, where j=l, 2, . . . , r, and 
Zy*sthe values of the system zeros used to construct the 
45 command tail, where j=l, 2, . . . , r. 

As expressed above, the one variable that may need further 
explanation is the pole multiplicity variable, q,-. The pole 
multiplicity is a number assigned to every system pole 
indicating the presence and number of repeated system 
50 poles. For nonrepeated poles, this value is simply 1. For 
repeated poles, the first pole would have q~l, the second 
pole would have q~2, the third pole would have q,=3, and 
so on. For example, for a given system with four poles, two 
repeated rigid body poles and a pair of complex poles at 
55 s=l±i, the following values of p,- and q,- would result: 

Pi=0, p 2 =0, p 3 =l+i, p 4 =l-i> and 
qi-1, q 2 =2, q 3 =l, and q 4 =l. 

With these variable definitions, we can now be clear about 
60 the nature of the system mathematics and the command 
profile equation. 

Representation of the Command Profile 

As discussed above, this derivation will be concerned 
with input commands that fall into the category of time- 
65 optimal or time-efficient command profiles. As discussed 
above, these types of command profiles typically contain a 
series of pulses or steps followed, in some cases, by an 
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exponentially decaying tail. As originally proposed in sec- 
tion 3, an expression can be created to capture the general 
profile of this family of commands: 


-continued 


Aj 




where the terms in this expression are defined above, and 
l(t) is the unit step command. In order to assist the clarity 
of the derivation to follow, the two distinct terms of this 
equation can be separated as follows: 

u(t)=u ± (t)+u 2 (t), (A.2) 


u \ (?) = and 

j = o 

«2 (0 = 

j= i 


As illustrated throughout this document, with the correct 
parameter values, not only can these equations represent all 
time-optimal command profiles for linear systems, but they 
can also capture the form of a wide range of time -efficient 
command profiles as well. 

Representation of the System Dynamics 

The derivation presented here will apply to SISO systems 
with any combination of linear dynamics. In general, a linear 
system can be expressed in the form of a SISO transfer 
function as follows: 


Now, given this general representation for the partial frac- 
tion expansion of a linear system, we can develop a general 
expression for the impulse response and step response of 
G(s). The resulting equations will be composed here since 
10 they are required in the derivation that follows. 

By taking the inverse Laplace Transform of the given 
transfer function, above, an expression can be created for the 
impulse response, g(t), of the system, G(s): 

15 g(t)=L- 1 {G(s)}=g 1 (t) +g2 (t) + . . . +g m (t)+K 2 b(t), (A.9) 

where 5(t) is the Dirac delta function. This equation can also 
be written as 


g(t) = Y i gi(t) + K 2 S(t). 


Now, in order to find an expression for g-^t), we must take 
25 the inverse Laplace Transform of the individual terms in 
equation A. 7. Performing this task results in the equation 




where, as defined above, q,- is the multiplicity of the pole p,-. 
Substituting this result into equation A. 10 yields the follow- 
ing general expression for the impulse response of a given 
linear system, G(s): 


(■S-Zl)(s-Z 2 ) ••• Cs-Sr) 
(s-p l )(s-p 2 ) ... ( s-p m y 




where the system variables are defined above and K, is the 4 o for &) From this result> we can also derive a genera i 


transfer function gain. Using a partial fraction expansion, 
this transfer function can also be expressed as 

G(s) = Gi (s) + G 2 (s) + . . . + G m (s) + K 2 (a.61 


equation for the step response, h(t), of the given linear 
system by taking the integral of the impulse response. More 
specifically, 


(S-pO ( s-p 2 ) (, s-p m ) 

where R, are the residues associated with each system pole 
in the expansion, and K 2 is the constant direct term, which 
is nonzero in the case where r=m. Equation A.6 applies only 
for the case when the given system has no repeated roots. If 
a given system does contain repeated roots, the following 
more general expression for the partial fraction expansion 
must be used: 

G(s) = Gi ( 5 ) + G 2 (s) + ... + G m (s) + K 2 (AD 


- K 2 6{t) dt 


-ftrU e Pi)dt\ + 


The integral in each of the two terms in this equation will be 
55 evaluated separately. In the simpler case, the second term of 
this equation can be reduced to: 


K 2 6(t)dt = K 2 l(t) = K 2 , for t > 0. 


where q,- are the pole multiplicities as defined above. Writing 
this expression with a more compact notation results in 

(A. 8) 

G(S) = 2G/(S) + K2 


In order to take the integral in the first term of this 
equation, two distinct cases must be considered separately. 
First, we will consider the case when p t -=0, and second, we 
65 will consider when p^O. In the first of these two cases, a 
general expression for each integral in the summation of 
equation A. 13 can be written as: 
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(A. 15) 


= 4 *. 


Now, for the case when p^O, this expression is somewhat 
more complex: 


hi(r)= £((^^ 1>ePi ') dr 

■Izs 


(A. 16) 


{piif qi ~ k) 


+ (-l T l 


15 


Although the derivation is not shown here, the reader can 
easily verify this result by evaluating the integral for some 
small values of q t - like q~l or 2. Given that an expression 
has been derived for all of the integrals in equation A. 13, a 
general result for the step response of the linear system can 
now be constructed by combining equations A.14, A. 15, and 
A.16: 


rbm „ 

A «=Z^ i + 


(A. 17) 


i=rbm + 1 


/ i (qi-k)l 


iPitf ' 1 ‘ 


-(-!)* 


-k 2 . 


for t^O. Note that the summation in equation A. 13 has been 
divided to separate the nonzero poles from the rigid-body 
poles. With this expression, our characterization of the 
time-response and frequency response of a given linear 
system is complete and we can proceed with the derivation 
of the residual response expression. 

Calculating the Residual Response 

For the given linear system transfer function, G(s), and a 
specified input command, u(t), the system output response 
can be expressed as 




(A. 18) 


where U(s) is the Laplace Transform of the input command, 
or equivalently 




(A. 19) 


where g(t) is the system impulse response and ‘ * ’ represents 
the convolution operation. Now, from equation A.2, we can 
rewrite equation A. 19 as 


50 


ym= X * (r) *«1(0 + (^2*5(0) *c/i(0- 


(A. 23) 


Substituting the expression for u a (t) from equation A.3 into 
this result yields 


10 


yi to = ft(oj * |Z ajH* - o)j + (^2*5(0 ) * ajl{t ~ 


(A. 24) 


Now, since this derivation is only concerned with the system 
residual vibration rather than the complete system response, 
we only need to consider the response after the time of the 
final switch in the pulse train, namely t^t„. This assumption 
reduces the complexity of the equations resulting from this 
derivation. In the case of equation (A.24), with this 
assumption, the second term becomes: 


20 


(K 2 S(t))* (t-tj) =K 2 £, 

J = 0 ) j = 0 


for t > t n . 


(A. 25) 


25 


30 


For the first term in equation A.24, a result can be more 
easily reached if we consider that the expression for u 2 (t) is 
simply a sum of weighted and shifted step commands. From 
linear system theory, this insight allows us to evaluate the 
convolution in the first term of this equation by constructing 
it from a sum of weighted and shifted step responses for each 
of the terms for g-^t). Following this reasoning, the first term 
in equation A.24 becomes 


35 




\J=» J 


m s 

t i‘M‘- 


o) 


(A.26) 


where h 1 (t) is the step response of the linear system that has 
40 the impulse response g,-(t). Now, combining the results from 
equations A.25 and A.26 into equation A.24, we have 


45 




1=0 


(A.27) 


for t^t„. As presented in equation A. 17, the general equation 
for the step response of a linear system was derived previ- 
ously. From the individual terms in this equation, a result for 
the value of the step response terms, h-^t), in equation A.27 
can be formulated. More specifically, for the case when p i is 
a rigid body pole, 


y(t)=yi(i)+y 2 (t), 

(A.20) 


(A.21) 

y2(t)=g(t)*u 2 (t). 

(A. 22) 


55 


where 


and u 2 (t) and u 2 (t) are defined according to equations A.3 
and A.4. Dividing the problem in this manner allows us to 
consider each of the two terms, y 2 (t) and y 2 (t), separately. 
Deriving an Expression for y 2 (t): 

From the expression for g(t) in A. 10, we can rewrite the 
equation for y 2 (t) as follows: 


hit) = 


and for the case when p,- is a nonzero pole, 


60 


R; 

h(t)= w 


Zj iqi-k)\ KPl) 


- (-1)*' 


(A.28) 


(A.29) 


65 Now, substituting these two expressions into equation A.27 
yields the complete general equation for the residual 
response due the command pulse train: 
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(A. 30) 



(-If- 1 ) 

(*;-*)! 


(p,-(r — r/)) to «' A) 


(-If + 


n 

... K 2 ^aj, for t > r„. 

7=0 


Deriving an Expression for y 2 (t): 

With a formula found to describe the first component, 
y 1 (t), of the residual response equation, an expression can 
now be derived for the second part, y 2 (t). Unlike the 
derivation for yft) which was performed wholly in the 
time-domain, the derivation for y 2 (t) will proceed in the 
frequency domain. Specifically, rewriting the expression for 
y 2 (t) in equation A.22 in terms of the Laplace Transforms for 
the system, G(s), and the tail of the command profile, U 2 (s), 
yields 


y 2 (t)=L~ 1 {G(s)U 2 (s)}. 


(A.31) 


Now, from equation A.8, G(s) can be represented as 


G(5) = £ 


R, 


£t(s-Piy« 


-k 2 . 


(A. 32) 


Also, by taking the Laplace Transform of the expression for 
u 2 (t) in equation A.4 results in 


U 2 (s) = e~ stn 



(A. 33) 


Substituting equations A.32 and A.33 into equation A.31 
produces the result 


y 2 (0 = L~ l 



e stfl R t Cj 

(s- Pi yn(s-z*j) 


+ L~ l \K 2 U 2 (s)}, 


(A. 34) 


which is equivalent to 


>2(0 


AVr'i 

ZjZj 1 (s- Pi yi(s-Q)) 


K 2 u 2 (t). 


(A. 35) 


=1 7=1 


Now, given equation A.4, the second term in the equation 
can be easily rewritten as 


5 


-if e-^RjCj \ 

' \(s- Pi y*(s-q)f 

L ~\ e 


Qij2 

(s-Pi) 2 


Q'wi 

{s-piT* 


(A .37) 


Qij(qj+ 1 ) )} 


or equivalently 

l _ { ( e~ stn RjCj } (A.38) 

\(s- Pi y« (s-z])} 

W 1 Qijk ) + Qij(gj + 1) 1 

£j (S-Pifj -</)]/’ 



where are the residues of the partial fraction expansion 
of the transfer function with numerator 1 and denominator 
roots p y , q z - times, and z y *. For example, in the case where 
20 q**l, the values for Q iJk are 


Qiji : 


(Pi ~zj) 


and Q ij2 = - 


(Pi~z)) 


Now, from this partial fraction expansion, we can evaluate 
the inverse Laplace Transform. Performing this task on the 
result in equation A.38 produces 


30 



Qijk Qijjgj + l) ) 
(s ~ Pit ) (* ~ Z*j) ) 


(A. 39) 


R;Cj 
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i ((Friyr 6 "* (? - + 




Finally, substituting this result, along with the result in 
equation A.36, into equation A.35 yields the following 
expression for y 2 (t): 


40 


i = 1 7=1 


* 2(r) Z \ RiCj 2 


(A .40) 
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for t^t n . With this result, the derivation of both y 2 (t) and 
50 ^ 2 ( 1 ) i s complete. All that remains, now, is to combine these 
results to find a general expression for the total residual 
response, y(t). 

Collecting Terms to Find y(t): 

The equation for the residual response of the linear 
55 system, G(s), to the time-optimal or time-efficient command 
profile, y(t), can be constructed by combining the results for 
y 2 (t) and y 2 (t): 


K 2 u 2 (t) = K-j^Cje’i" for t>t„. 
7=1 


(A 36) y(t)=y 1 (t)+y 2 (t). (A. 41) 

Specifically, using the results from equations A.30 and A.40, 
the following expression can be created: 


For the first term in equation A.35, however, we must first 
find a method for taking the inverse Laplace Transform of 
the expression in braces. This can be done by using a partial 65 
fraction expansion. Specifically, the quantity in equation 
A.35 can be expressed as 





m 


i=rbm + 1 


(A .42) 
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K-D ffi 


2 




# 2 ^ c/e z -/ (f fn) , for t > t n . 
j= i 


Understanding the Residual Response Equation 

Equation A. 42 can be used to calculate the profile of the 
residual response for any SISO, LTI system to any time- 
optimal or time -efficient command input that can be 
described by equation A. 1. By reorganizing the terms in this 
equation, a better understanding can be gained about the 
contribution of the individual system dynamics to the overall 
residual response. Specifically, by regrouping the terms in 
the expression above, the following equation can be derived: 


then this term will be nonzero. Also, this term disappears if 
the system has no zeros. 

From this understanding of the system residual response, 
we can get a better idea of the origins of the problem 
5 constraints for the time-optimal control problem. As dis- 
cussed in section 3, three basic constraints are imposed by 
the time-optimal control problem. The first states that the 
time-optimal command profile must produce rest-to-rest 
motion in the system output. The second states that the 
10 system output must change by a desired amount, dy, and the 
third states that the command profile must not violate the 
actuator limits. This last constraint is easily satisfied by 
selecting command amplitudes that remain within the speci- 
fied system actuator limits. For the first two constraints, 
15 however, detailed equations were derived in section 3 to 
relate the system output behavior to the parameters describ- 
ing the input command. These two types of constraints were 
named the dynamics cancellation constraint and the bound- 
ary condition constraint. From equation A. 43, we can get a 
20 better understanding about the origins of these constraints. 

First, for the case of the dynamics cancellation constraint, 
the resulting equations, when satisfied, ensure that the 
system will not have any residual vibration when the final 
resting state has been reached. In order for this to be true, 


y(t) = 





ajit-tjfi + 


(A. 43) 

(term la) 


(term lb) 


rbm r q . 

(term lc) 



2 



(-If- 1 ) 

(«-*)! 




(term 2) 


2 


Cj€ P ‘ tn 



Qijk 

T)! 


(r-t n f 


V Z for/Sf,. (term 3) 

\^\ J=l J=l 


By observing the individual terms in this equation, some 
statements can be made about the contribution of each. First, 
the three terms la, lb, and lc, represent the total rigid-body 
motion produced in the system by the given command. In 
particular, term la has a value equal to the total system 
rigid-body motion in the cases where there are no system 
rigid-body modes. When a system does contain rigid-body 
modes, however, terms lb and lc become nonzero. Note that 
if the system contains no zeros, term lc will be zero since 
the tail coefficients, c y, will be zero. Term 2 in equation A.43 
represents the contribution of the system denominator 
dynamics to the overall residual response. If the specified 
input command profile does not cancel all of the system 
poles, then this term will be nonzero and describe any 
response, such as oscillation, around the final system steady- 
state value. Term 3 in this equation, describes the contribu- 
tion of any system zeros to the residual response. If the tail 
of a time-optimal or time-efficient command does not drive 
the system exactly at the frequencies of the system zeros, 


both terms 2 and 3 in equation A.43 must be exactly zero. 
50 For term 3, this condition is satisfied if the values for the 
system zeros used in the command profile, z-*, exactly 
match the actual system zeros, z When this occurs, the 
values of the residues, R- and Q ij( qi +iy an ^ the direct gain, 
K 2 , will combine to a value zero. For term 2, although not 
55 immediately apparent, the bracketed expression is a more 
complicated form of the dynamics cancellation constraint 
equation from section 3. Therefore, if the dynamics cancel- 
lation constraint is satisfied, term 2 will go to zero and the 
command profile will not excite any residual vibration. This 
60 will be illustrated more clearly in the simple example to 
follow. 

The boundary condition constraint in the time-optimal 
control problem ensures that the command profile will move 
the system output by the desired amount, dy. In terms of the 
65 residual vibration equation, A.43, this constraint is captured 
in terms la, lb, and lc. In other words, if the command 
profile is designed to satisfy the boundary condition 
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constraint, then terms la, lb, and lc will be guaranteed to 
sum to the desired value of dy. Setting the value of these 
three terms equal to dy is an equivalent statement to the 
boundary condition constraint outlined in section 3. 

From this analysis of the residual response equation, it is 
clear that the set of constraints imposed for the time-optimal 
control problem is the minimum, necessary set required to 
ensure that the residual response behaves as desired. 
Furthermore, as will be illustrated in the example below, 
these constraints represent the simplest expressions that can 
be composed to require the system residual response to 
behave accordingly. 

A Simple Example 

In order to gain a better understanding of the relationship 
between the time-optimal problem constraints derived in 
section three and their impact on the system residual 
response, consider the simple system 


G(s) = 


(s-Zi) 

c s-p\){s-p 2 y 


(A .44) 


where p 1 ^p 2 - From the variable definitions at the beginning 
of this Appendix, the following values can be assigned: 
rbm=0, m=2, r=l, q 1 =l, and q 2 =l. Also, assuming that the 
time-optimal command profile for this system will have a 
pulse train with two switches, not including the first, then 
n=2. Now, by taking the partial fraction expansion of the 
system transfer function, the following values can be found 
for the residues and the direct gain: 


Ri 


Pl~Zi Pl~Zi 

«2 = , 

Pi - Pi Pi - Pi 


and K 2 = 0. 


Also, by taking the partial fraction expansion of the transfer 
function with numerator 1 and denominator roots p ( - and z y *, 
values for the following terms can be found 

1 1 

Qiji = and Q ij2 = 7 . 

Pi-Z) Pi-Zj 

Therefore, substituting these values and expressions into the 
general equation for the system residual response in equa- 
tion A.43 yields: 

y(t) = -(— + — )(flo + fli + a 2 ) + . . . ( A - 45 ) 

\p 1 Pi' 

— € p i t (a 0 £~ p i t ° + aie~ Pltl + 

Pi 

a 2 e~ p i f 2 +c l e~ p ^ Pl Q ni ) + ... 

R-> 

— e P2t (a Q e P2tQ + a^e P2t i + 

Pi 

a 2 e~ P2t2 + ae~ P2t2 piQm) + ... 
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-continued 


ClPl 


Pi -Zl 


)*■■■ 


1 

Pi 


{P2 Zl) e P2t (aoe- p2t o + a l £~ P2t 1 + 
(Pi-Pi) ( 


a 2 £ p 2 f 2 + e~ P2t i 


Pi -z\) 


Zi -ZI 


U4 -piXzl -pi)) 


\e z l {t ~ t2) . 


From this equation, it can be seen that, if a time-optimal 
command profile is designed using a value for z ± * that is 
15 identical to the actual system zero of z 1 , then the last term 
in this expression disappears. Recalling the previous 
discussion, the first term in this equation represents the total 
system output rigid-body motion. It is an equivalent state- 
ment to the boundary condition constraint, and if satisfied, it 
20 will exactly equal dy, the desired system output transition. 
Finally, the second and third term in this equation describe 
any system residual vibration excited by the command pulse 
train. In order to satisfy the time-optimal control problem, 
these terms must be equal to zero. Fortunately, referring to 
25 the constraint equations in section 3, it can be seen that, if 
that the dynamics cancellation constraints are satisfied, the 
expression in parenthesis in both terms must be equal to 
zero. More specifically, the parenthetical expression in term 
2 is the dynamics cancellation constraint for the first system 
30 pole, and the parenthetical expression in term 3 is the 
dynamics cancellation constraint for the second system pole. 
From this reasoning, it can be better seen that the constraint 
equations posed in the time-optimal control problem in 
section 3 correspond to the minimum set of necessary 
35 conditions that need to be enforced to ensure proper behav- 
ior in the system output response. 

Appendix B 

As discussed in section 3, the boundary condition con- 
40 straint for the time-optimal control problem requires that the 
integral of the command profile be evaluated. For systems 
that contain multiple rigid-body modes, this integral needs 
to be evaluated multiple times. This appendix presents the 
derivation of an expression that can be used to evaluate the 
45 integral of the command profile analytically. Unlike numeri- 
cal integration methods, this analytic integral allows for 
rapid calculation of the boundary condition constraint and 
provides a result that is exact. The derivation will proceed by 
considering the integral of the two command components 
50 separately. First the analytic integral for the command pulse 
train will be considered followed by the integral of the 
command tail. 

The Analytic Integral of the Command Pulse Train 

As discussed in section 3, the general equation for the 
55 pulse train of a time-optimal or time-efficient command can 
be expressed as 


RiciQin^* t2) + RiciQ2iie z * l{t t2 \ 

or equivalently 

y(t) = - -5— (a 0 +a l +a 2 ) + ... (A. 46) 

Pi Pi 

— [Pi — filgPufflQg-PUo +aie~ Plt i + 

Pi (pi ~ Pi) { 


j= 0 

60 

Now, in order to calculate the analytic integral of this 
expression, we will only consider the value of the integral at 
the specified switch times, t-. For example, for the given 
65 command profile, a vector can be constructed with one 
element for each switch. Each element represents the value 
of the command or its integral at the corresponding switch 
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time. For the command specified by equation B.l, this vector 
would be 



«oo 


0 


«01 


Oo 

Uq = 

0-02 

= 

ao + a\ 


.«03 . 


CIq + 4 - 0,2 


value is constructed by adding the integral over a single 
pulse to the integral over all of the previous pulses. Follow- 
ing this pattern, a general expression can be formulated to 
evaluate the integral of the command pulse train any number 
of times. Since this formula is most easily expressed in 
vector form, let us first define some useful vectors. To 
capture the values for the time spacing from one switch time 
to the next, consider the following vector: 


The first value of this vector corresponds to the initial 
command amplitude, which will be assumed to be always 
zero. The second element corresponds to the value of the 
amplitude of the command pulse train slightly before the 
switch time t 1 . The third element corresponds to the com- 
mand amplitude value just before the switch time t 2 , and so 
on. Following this protocol, a similar vector can be con- 
structed for the first integral of the command pulse train: 


?o - 0 

h - to 
dt= h ~ h 


Also, another useful vector can be defined which represents 
the values of the various integrals of the command profile 




0 

r('i-'o) 

(B.3) 20 
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_«13. 


«12 + «02(*3 “ t2) + 

r(t3- f 2> 

I a 2 dt 
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Jo 



. Oi(n-l) . 


«io + w oo(/i - ? o) + a 0 (*1 - f o) 

W 11 + w 0l(/2 - *l) + a l ( t2 - h) 

«12 + «02(f3 “ t2 ) + 0-2 ih “ t2) 


where the initial value for the first integral of the command 
is assumed to be zero. For each element in this vector, the 
integral is calculated by evaluating the integral from one 
switch to the next and adding the result to the integral over 
all of the previous switches. Following this pattern, a similar 
vector can be constructed for the second integral of the 
command pulse train: 


where n is the number of switch times in the pulse train. 
Now, given these vector definitions, the following formulas 
can be created to define the integral of the command pulse 
train at the values of the switch times. For the first integral 
of the command pulse train, another way to express equation 
B.3 is 

M^cumsumiwo-*^), (B.7) 

where u 0 is defined according to equation B.2 and the 
operator, * represents the element-by-element multiplication 
of the two vectors. Also, the cumsum( ) function in this 
equation performs the task of adding to each vector element 
all of the previous elements in the vector. Following this 
precedent, an expression for the second integral of the pulse 
train can be written as 


«21 

U-2 = w 22 


45 u 2 = cumsum| -w 0 . %dt 2 +u\.* dtj. 


«21 + w ll( f 2 - *i) + 


«22 + « 12(*3 - 


-t 0 )+^a 0 (t l -toY 


«2i + w n (t 2 ~h) + - ( a 0 + a\ )(t 2 - ?i) 


0-22 + «i2te - 


tl) +-(^0 + ^1+ a 2 )ih - t 2 ) 


where the ( ) 2 operation defines the square of each vector 
element. This equation for the second integral of the com- 
50 mand profile delivers the same result as the expression in 
equation B.4. Following the same approach, similar expres- 
sions can be formed for additional integrals of the command 
pulse train: 


Again, this vector assumes an initial value for the second 
integral of the command to be zero, and each subsequent 


« 4 = cumsum 


(l ,1 

= cumsunil — -uq. * dr + -u\. 

nsum 

( 1 4 1 
{2^4 u °'* dt + 2y$ u * l '* dr 


and so on. To reiterate, each of these vectors, u,-, represents 
the values of the i-th integral of the command pulse train at 
each switch time in the command. The value of the i-th 
65 integral of the entire pulse train is available in the last 
element of u,-. Conveniently, the form of the equations 
derived above allows for easy implementation in a matrix 
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algebra programming environment such as Matlab. Listed in 
Table B.l is a computer-executable implementation of these 
equations to calculate the integral of a command pulse train 
any number of times. Since this code relies on the fast matrix 
and vector operations performed in Matlab, these integrals 5 
can be calculated very rapidly. Additionally, due to the 
compact notation, very few lines of code are required to 
perform this calculation. 


102 

grating equation B.12, an equation for the first integral of the 


tail, u 1 (t), can be calculated to be 


ui (t) = J* u{t)dt = c/e z -/ f jdr 

(B.16) 

r c . 

= ^ + constant 

(B.17) 


j = 1 


TABLE B.l 


Matlab code to calculate the integral of the command pulse train. 


% Given two row vectors, one containing the pulse train 
% amplitudes, a, and switch times, t, the following code can 
% be used to evaluate the integral of the pulse train 
% intnum times. This code assumes that the initial command 
% value and the initial value of all its integrals are 
% zero. The result of this integral over the entire length 
% of the pulse train is returned in the variable result. 

% Initialize the matrix storing the integrated result. 

% Each row, ii, of this matrix contains the ii-th integral 
% of the command at every switch time except the first. 

U = cumsum(a); 

Utemp = U; 
n = length(a); 

% Now perform the integration loop with one loop for each 
% order of integration, 
for ii = l:intnum, 

if ii==l, Utemp = cumsum(U.*dT); else 
Utemp = cumsum(sum(U.*dT)); end; 

U = [U; [0 Utemp (l:n-l)]]; 

dT = [(l/(ii+l)) * dT(l,:) .* dt; dT]; 

end; 

result = Utemp (n); 


The initial condition in equation B.13 can be used to derive 
an expression for the constant in this equation. Performing 
this task yields 


15 


constant = wio 


r 

-Z 

;=1 


C J_ 

Zj' 


(B .18) 


Therefore, combining this result with equation B.17 pro- 
duces the final expression for the first integral of the com- 
mand tail: 


25 


«1 to = 





j = 1 


(B .19) 


Following a similar procedure, this task can also be per- 
formed for the second integral of the command tail, u 2 (t), to 
30 derive the result 


The Analytic Integral of the Command Tail 

With an expression derived to calculate the integral of the 
pulse-train portion of the optimal command, all that remains 
is to derive a similar expression for the tail. This derivation 35 
can begin by considering the general equation for the tail of 
a time -optimal or time -efficient command: 


H2to=JJ«to^=jHlto^ 

W 2 to = f J" u ( r )dt = J' Hi (t)dt 


(B .20) 


H 20 




' * (B .11) 

u{t) = Yj Cje z J {t - tn) l(t-t n ). 
j= 1 

Since we are concerned now with calculating the integral of 
this equation only for times t^t n , we can simplify this 
expression to: 


40 

where u 20 is the initial condition from equation B.14. 
Similarly, the third integral of the tail, u 3 (t), can be 
expressed as 

45 «3to=J 1 1 u(t)dt=\ u 2 (t)dt 


«to = 2 c j £ZJt - 

j=i 


(B.12) 


50 


In order to calculate a general analytic expression for the 
multiple integral of this equation, we must first specify the 
initial conditions of the integration. More specifically, 


((/ w(f H l ) r=0 = “ 10 ’ 

(B.13) 

((//“ w ^)IL„ =W2< ” 

(B.14) 

(LPHL- 

(B .15) 
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u 2 (t)dt 



j= 1 



1 
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«io 




(B .21) 


Now, following the pattern suggested by these results, a 
general expression for the n-th integral of the command tail 
can be formulated as follows: 


/ «) 

u(t)dt 


(B .22) 


Now, to get a better understanding of the form of a general 65 
expression for the n-th integral of the tail equation, let us 
consider the first few integrals of command tail. By inte- 


u nO 
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-continued 



As indicated in Table B.2, this equation can be implemented 15 
easily into a r matrix algebra programming environment, 
such as Matlab, to rapidly calculate the integral of the 
command tail any number of times. In order to perform this 
integration, however, a final time for the integration must 
first be specified. Since the value of this final time has no 20 
influence over the amount of computation required, it can be 
selected to be sufficiently large enough to let the command 
settle to its final steady-state value. 

TABLE B.2 25 

Matlab code to calculate the integral of the command tail. 

% Given two row vectors, one containing the tail coefficients, 

% c, and one containing the values of the tail exponents, z, 

% the following code can be used to evaluate the integral of 30 

% the tail of a time-optimal or time-efficient command 
% intnum times. The result of this integral over from the 
% start of the tail to the final time, tf, is returned in the 
% variable result. The initial conditions are specified in 
% the initial condition vector ic, which should have as many 
% elements as the desired number of integrations, intnum. ^5 

% The time integral of a sum of exponentials consists of a 
% polynomial in ‘t’ with as many terms as there are integrations 
% plus an additional term containing a sum of exponentials, 
coefs = [ ]; 
for ii = 0:intnum-l, 
n = intnum - ii; 

coefs = [coefs (l/fact(ii))*(ic(n) - sum(c./(z. n)))]; 40 

end; 

coefs = fliplr(coefs); 

result = polyval(coefs,tf) + sum((c./(z. intnum)).* exp (z*tf)); 

The Analytic Integral of the Entire Command 45 

With the expressions derived in this appendix, it is pos- 
sible to calculate the integral of the time-optimal or time- 
efficient command pulse train and tail. In order to obtain a 
value for the integral of the entire command, the separate 
expressions for the two different tail components can be 50 
combined as follows. First, using the code in Table B.l, for 
example, the integral of a given command pulse train can be 
calculated from the initial time to the final command switch 
time. This result can then be used as an initial condition to 
calculate the integral of the command tail. The value reached 55 
by this calculation will represent the value of the command 
integral from the start of the command to a specified final 
time. For multiple integrals, the code to integrate the com- 
mand pulse train can be used once for every desired integral. 
The resulting values can be used as an initial condition 60 
vector for the integration of the command tail. 

Since the equations derived in this appendix are compact 
and can be expressed in matrix form, they can be imple- 
mented easily as computer-executable code. Because this 
code is based on an analytic solution to the integral of the 65 
command profile, calculation is much faster than a standard 
numerical integration. Also, unlike a numerical integration, 
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the result is exact. From this result, it is clear that the integral 
for any time-optimal or time-efficient command can be 
evaluated quickly and easily. Employing these expressions 
to impose the boundary condition constraint in the time- 
optimal control problem will similarly reveal that this 
approach is highly effective for deriving time-optimal and 
time-efficient command profiles. 

What is claimed is: 

1. A method of determining an input command profile for 
a dynamic system that can be modeled as a linear system, the 
input command profile for transitioning an output of the 
dynamic system from one state to another state, the method 
comprising the steps of: 

identifying characteristics of the dynamic system; 

selecting a command profile which defines an input to the 
dynamic system based on the characteristics identified 
in the identifying step, the command profile comprising 
one or more pulses which rise and fall at switch times 
and the command profile being useable with substan- 
tially any dynamic system that can be modeled as a 
linear system; 

imposing a plurality of constraints on the dynamic 
system, at least one of the constraints being defined in 
terms of the switch times; and 

determining the switch times for the input to the dynamic 
system based on the command profile and the plurality 
of constraints. 

2. A method according to claim 1, wherein the character- 
istics identified in the identifying step relate to poles and 
zeros of the dynamic system. 

3. A method according to claim 1, wherein the plurality of 
constraints include a dynamics cancellation constraint which 
specifies that the input moves the dynamic system from a 
first state to a second state such that the dynamic system 
remains substantially at the second state. 

4. A method according to claim 1, wherein the plurality of 
constraints include boundary condition constraints, the 
boundary condition constraints including an initial time of 
the input and a specified change “dy” in the output of the 
system. 

5. A method according to claim 4, wherein the boundary 
condition constraints are based on the following equations: 


dy = lim w(r) d t 


where u(t) represents the command profile, N(s) repre- 
sents at least a part of a numerator of a transfer function 
of the system, D(s) represents at least a part of a 
denominator of the transfer function of the system, and 
“rbp” corresponds to rigid body poles in the system. 

6. A method according to claim 1, wherein the plurality of 
constraints include an actuator limit constraint, the actuator 
limit constraint corresponding to limits in the system which 
keep the input within limits of the actuator. 

7. A method according to claim 1, wherein the determin- 
ing step comprises determining the switch times based on: 
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(i) a command profile, u(t), comprising: 


n r 

u{t) = ^ ajl(t - tj ) + Yj Cje Zj{t ~ tn) l(r - r„), 
j = o j = i 


Z- 


fa,-u -ar - 


= 0, 


where “a” represents an amplitude of pulses in the 
function, “i” represents switch times for the pulses, 

“c ” represents coefficients of exponential terms in a tail 
of the command profile, “z ” represents zeros in the io 
system, “n” represents a total number of switches 
excluding a first switch, and “r” represents a number of 
zeros in the system, 

(ii) a dynamics cancellation constraint comprising: 


where “p/’ represents system poles, and “q” represents a 
multiplicity of each system pole “p/’, and (ii) the 
boundary condition constraints comprise: 

f o =0 




j = o 


,n Z ^" 1,+ Z 








where “p/’ represents system poles, “q/’ represents a 
multiplicity of each system pole “p/’, and where p is 
defined as follows: 


(iii) boundary condition constraints comprising: 


? 0 — o 




where N(s) represents at least a part of a numerator of 
a transfer function of the system, D(s) represents at 
least a part of a denominator of the transfer function of 
the system, and “rbp” corresponds to rigid body poles 
in the system, and 

(iv) an actuator limit constraint comprising: 

Umin=Utail{t) = Umax, 

where u min represents a minimum value of the input, 
UfatfO) represents a value of a tail of the input at time 
“t”, and u max represents a maximum value of the input. 

8. A method according to claim 7, wherein the switch 
times are determined using an optimization algorithm. 

9. A method according to claim 1, wherein, in a case that 
the identifying step identifies that the dynamic system 
contains poles only and no zeros, (i) the command profile 
comprises: 


n 


u(t) = Y 

j = o 


where “a represents an amplitude of pulses in the 
command profile, u if represents switch times for the 
pulses, and (ii) the plurality of constraints include only 
a dynamics cancellation constraint and boundary con- 
dition constraints. 

10. A method according to claim 9, wherein (i) the 
dynamics cancellation constraint comprises: 


where N(s) represents at least a part of numerator of a 
transfer function of the system, D(s) represents at least 
a part of denominator of the transfer function of the 
2Q system, and “rbp” corresponds to rigid body poles in 
the system. 

11. A method according to claim 1, further comprising the 
step of verifying optimality of the input which includes the 
switch times determined in the determining step. 

25 12. A method according to claim 11, wherein the opti- 

mality of the input which includes the switch times deter- 
mined in the determining step is verified based on Pontrya- 
gin’s Minimum Principle. 

13. An apparatus which determines an input command 
3Q profile for a dynamic system that can be monitored as a 
linear system, the input command profile for transitioning an 
output of the dynamic system from one state to another state, 
the apparatus comprising: 

a memory which stores computer-executable process 

35 steps; and 

a processor which executes the process steps stored in the 
memory so as (i) to identify characteristics of the 
dynamic system, (ii) to select a command profile which 
defines an input to the dynamic system based on 
40 identified characteristics, the command profile com- 

prising one or more pulses which rise and fall at switch 
times and the command profile being useable with 
substantially any dynamic system that can be modeled 
as a linear system, (iii) to impose a plurality of con- 
45 straints on the dynamic system, at least one of the 
constraints being defined in terms of the switch times, 
and (iv) to determine the switch times for the input to 
the dynamic system based on the command profile and 
the plurality of constraints. 

50 14. An apparatus according to claim 13, wherein the 

characteristics identified by the processor relate to poles and 
zeros of the dynamic system. 

15. An apparatus according to claim 13, wherein the 
plurality of constraints include a dynamics cancellation 

55 constraint which specifies that the input moves the dynamic 
system from a first state to a second state such that the 
dynamic system remains substantially at rest at the second 
state. 

16. An apparatus according to claim 15, wherein the 
60 command profile includes a tail following the one or more 

pulses; and wherein the dynamics cancellation constraint is 
based on the following equation: 


65 


X' 


tof-l) -st: 
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= 0, 


where “a-” represents an amplitude of pulses in the 
command profile, “t” represents switch times for the 
pulses, “c-” represents coefficients of exponential terms 10 
in the tail, “z” represents zeros in the system, “n” 
represents a total number of switches excluding a first 
switch, “r” represents a number of zeros in the system, 
“p/’ represents system poles, “q/’ represents a multi- 
plicity of each system pole “p/’, and where p is defined 15 
as follows: 


where “p f ” represents system poles, “q/’ represents a 
multiplicity of each system pole “p and where p is 
defined as follows: 

(iii) boundary condition constraints comprising: 

?o = 0 

dy = oo, 


17. An apparatus according to claim 13, wherein the 20 
plurality of constraints include boundary condition 
constraints, the boundary condition constraints including an 
initial time of the input and a specified change “dy” in the 
output of the system. 

rye 

18. An apparatus according to claim 17, wherein the 
boundary condition constraints are based on the following 
equations: 


)L 

35 

where u(t) represents the command profile, N(s) repre- 
sents at least a part of a numerator of a transfer function 
of the system, D(s) represents at least a part of a 
denominator of the transfer function of the system, and 
“rbp” corresponds to rigid body poles in the system. 40 

19. An apparatus according to claim 13, wherein the 
plurality of constraints include an actuator limit constraint, 
the actuator limit constraint corresponding to limits in the 
system which keep the input within limits of the actuator. 

20. An apparatus according to claim 13, wherein the 45 
processor determines the switch times based on: 

(i) a command profile, u(t), comprising: 

n r 

«(0 =Yj ^ ~ ^ + Yj C j eZj(t ~ tn) Kt~tn), 50 

J= 0 J= 1 


where N(s) represents at least a part of a numerator of 
a transfer function of the system, D(s) represents at 
least a part of a denominator of the transfer function of 
the system, and “rbp” corresponds to rigid body poles 
in the system, and 

(iv) an actuator limit constraint comprising: 

Umin=U tai l{t) = U max , 

where u min represents a minimum value of the input, 
u^ 7 (t) represents a value of a tail of the input at time 
“t”, and u max represents a maximum value of the input. 

21. An apparatus according to claim 20, wherein the 
switch times are determined using an optimization algo- 
rithm. 

22. An apparatus according to claim 13, wherein, in a case 
that the identifying step identifies that the dynamic system 
contains poles only and no zeros, (i) the command profile 
comprises: 

n 

u(f) = Y J a j l(t-t j ), 
j= 0 

where “a-” represents an amplitude of pulses in the 
command profile, “t y ” represents switch times for the 
pulses, and (ii) the plurality of constraints include only 
a dynamics cancellation constraint and boundary con- 
dition constraints. 

23. An apparatus according to claim 22, wherein (i) the 
dynamics cancellation constraint comprises: 


where “a 7 ” represents an amplitude of pulses in the 
function, “y” represents switch times for the pulses, 55 
“c ” represents coefficients of exponential terms in a tail 
of the command profile, “z 7 ” represents zeros in the 
system, “n” represents a total number of switches 
excluding a first switch, and “r” represents a number of 
zeros in the system, 60 

(ii) a dynamics cancellation constraint comprising: 






Z‘ 

j = 0 




= 0 , 


where “p/ 5 represents system poles, and “q/’ represents a 
multiplicity of each system pole “p ( ”, and (ii) the 
boundary condition constraints comprise: 


?o = 0 


“H, s 


65 


where N(s) represents at least a part of a numerator of a 
transfer function of the system, D(s) represents at least 
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a part of a denominator of the transfer function of the 
system, and “rbp” corresponds to rigid body poles in 
the system. 

24. An apparatus according to claim 13, wherein the 
command profile further comprises, after a last one of the 
one or more pulses, a tail which trails off to a constant value; 
and 

wherein the plurality of constraints comprise insensitivity 
constraints that include a constraint which limits a 
length of the tail. 

25. An apparatus according to claim 24, wherein the tail 
is defined by a function u ffll7 (t) which comprises: 

^ U-tSUBn) 

U tail (t) = 2 jC j£ J l{t-t n ), 

j= 1 


where “c ” represents coefficients of exponential terms in 
the tail, “z ” represents zeros in the system, “n” repre- 
sents a total number of switches excluding a first 
switch, and “r” represents a number of zeros in the 
system; and 


no 

wherein the length of the tail is limited by limiting values 
of coefficients “c ”. 

26. An apparatus according to claim 25, wherein the 
values of the coefficients “c” are limited by: 

5 

r 

< Xu, m , 

j= 1 


io where “u 1/m ” defines an actuator limit, “X” defines a 
percentage relative to limit u lim within which the tail 
settles, and £,-(»■ define a real component of zeros “z” 
within the system. 

27. An apparatus according to claim 13, further compris- 
ing the step of verifying optimality of the input which 
includes the switch times determined by the processor. 

28. An apparatus according to claim 27, wherein the 
optimality of the input which includes the switch times 
determined in the determining step is verified based on 
Pontryagin’s Minimum Principle. 



